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ABSTRACT 


The study of human driving of automotive vehicles is an important aid to the 
development of viable autonomous vehicle navigation techniques. Observation of 
human behavior during driving suggests that this activity involves two distinct 
levels, the conscious and the unconscious. 

Conscious actions relate to the logical behavior of a driver such as stopping 
the vehicle when a ‘traffic light is red. stowing down the vehicle when it turns a 
bend. etc. Such behavior can be described using natural human language. The 
unconscious actions of a driver are much less obvious. There are many such 
activities occurring while we are driving a vehicle to a particular destination. One 
of the important unconscious efforts involves the selection of successive points on 
the road to steer the vehicle towards in order to achieve the desired road-following 
behavior. This research work attempts to mimic this unconscious behavior 


through the use of a computer simulation model. 
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I. INTRODUCTION 


A. GENERAL BACKGROUND 

Today there are many robots employed all over the world, especially in the 
USA and Japan. to do various kinds of industrial work. The benents realizable 
through the use of these robots are numerous, easily attained. and, most 
importantly. proven. However. most of these industrial robots either lack any 
external sensory mechanisms or have only a few unsophisticated sensors Refs. 1- 
o 

Robots that do not have any external sensors normally operate from a fixed 
position. They are programmed to perform a series Of movements to accomplish a 
desired task. Once programmed, these robots repeat the programmed movements 
as INmany times as desired, accurately and precisely, regardless of the external 
environment. 

The other kind of robot, the kind equipped with a few unsophisticated 
sensors, is able to perform limited sensing of the environment. Such a robot is 
capable of adapting to simple and small changes in the operating environment 
such as stopping when an unexpected object crosses into its path. 

With the advent of the information age and microprocessor technologies, yet 
another kind of robot is becoming realizable. These kind of robots are called 
autonomous robots. Such robots are capable of making their own decisions and 
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adapting quickly and safely "on-the-fly" to accomplish a mission [Refs. 4-5]. Such 
robots can either operate from a fixed position or from a mobile platform. In the 
case of mobile robots, the system can also be capable of avoiding obstacles along 
its navigation path. In this respect, a human being can be considered to be an 
extreme example of an ideal autonomous robot. 

Humans receive information about their environment from two groups of 
sensors [Ref. 6]. One group provides conscious sensing and the other group 
provides subconscious sensing. The first sensing group comprises the five basic 
human sense organs: ears. nose. mouth. touch and eyes. Hach of these sensors nas 
a specialized processor attached to it which analyzes the sensor input. This is 
especially so with the eves which provide humans with one of the most complex 
vision systems found in nature. A human is able to identify different objects 
under a wide variety of environmental conditions such as varying viewing 
distance, viewing angle, brightness, contrast, etc. 

The second group of sensors provides proprioceptive information, which 
according to Thring [Ref. 7], gives an overall internal model of our body. It also 
provides inertial information from the vestibular system that senses body 
orientation, balance, and rotation. 

All information received by the five basic sensors is sent to the highly complex 
cerebral cortex which acts as the central processor of the entire system [Ref. 7]. 
After processing the various sensory inputs, the cerebral cortex sends signals to all 


parts of the body including the cerebellum [Ref. 7]. 
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The cerebellum is the chief coordinator of our motion system. Besides 
receiving information from the cerebral cortex about what movements are 
required, it also receives information from the vestibular system and the 
proprioceptors in order to be able to command muscular movements [Ref. 7]. 

The above oversimplified discussion of an ideal autonomous robot is intended 
to illustrate the complexities involved in building a real autonomous mobile robot. 
It must have a very elaborate and sophisticated sensory mechanism. numerous 
high-speed information processors working in parallel. and a very large and 
sophisticated controiling software svstem in order to acnieve complete autonomy. 

Finally. human beings achieve their mobilitv mainly througn a pair or legs. 
but this is not necessarily so for an autonomous mobile robot. There are many 
ways for an autonomous mobile robot to achieve mobility on land. For local 
motion the alternatives are wheeled systems, tracked systems and legged systems 
[Ref. 8]. Of the three, the legged system is probably the most flexible but also the 
least understood method. There is a great deal of research currently underway on 
walking machines [Refs. 8-12]. 

Several attempts to build an autonomous wheel-based mobile robot were 
carried out as early as the 1960’s [Ref. 13]. However, none of this research was 
able to deliver a completely autonomous robot. Some of these earlier works will 
be discussed in Chapter II. A number of research projects that are currently being 
carried out seem to be much more successful than their predecessors. The main 


reason for this could be that their predecessor’s failures had prompted several 
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related smaller research studies in areas such as sensor hardware, machine vision, 
and computer architectures to be carried out instead. The results of these research 
efforts are now being consolidated into the latest autonomous vehicle projects. 
One of the areas which has received relatively little attention in previous and 
current research work on autonomous vehicles is that of human navigation and 
driving. This area may be pertinent to the viability of the future of autonomous 
vehicles. especially those on-road and wheeled-based. The objective of this work 


is tO investigate and mimic a human driver driving a conventional automobile. 


B. ORGANIZATION 

Chapter II reviews some or the early research projects on autonomous mobile 
robots done in the late 1960's. Much of this work provides the necessary 
background for several autonomous vehicle research projects that are currently 
being carried out. Some of these later research projects are also summarized in 
this chapter. 

The objective of this research work in relation to autonomous vehicles is 
discussed in greater depth in Chapter IJ]. In this chapter, some of the basic 
aspects of conventional automotive vehicle mechanics are also explained. This is 
to show that the graphics simulation built for this study ignores many complex 
interactions that occur between a vehicle and its environment when the vehicle is 
moving. That is, a number of simplifying assumptions are made in this chapter 


so as to make the graphics simulation more feasible within the time constraints of 


this study. The mathematical model used for the graphics simulation is also 
derived and described in Chapter III. 

The entire graphics simulation is implemented in C. The functions of the 
various modules developed for the simulation are described in Chapter IV. This 
chapter elaborates the overall software design strategy and the important issues 
that. must be addressed when the software is to be improved or modified. The 
procedure for changing various vehicle gains is also described in this chapter. 

Numerous experiments were conducted with the simulation modei to support 
the validity of this work and the mathematical model used. Chapter V recoras 
and explains the resuits of all the experiments conducted using the simulation 
mode}. 

The last chapter, Chapter VI, summarizes the work done and its benefit to 
autonomous vehicle research. Suggestions about some possible extensions to this 
research work are also given. This additional work would make the present study 
more comprehensive and substantiative. 

Chapter VI is followed by a list of reference material used for this study. 


Finally, the graphics simulation source code is attached as an appendix. 
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II. SURVEY OF PREVIOUS WORK 


A. INTRODUCTION 

Research in autonomous systems began as early as the late 1960’s ‘Ref. 13]. 
Many of these early research efforts did not fully materialize. mainly because of 
the technological limitations existing at that time. The outcome of these 
investigations. however. indicated that the complexity involved in certain areas 
such as image processing, scene analysis. planning, etc.. required more work before 
further attempts to build autonomous systems could continue. 

Since then. major advances and significant breakthrougns in several areas of 
technology have made many tasks which were difficult to implement or even not 
possible in the 1960’s become more feasible. Improvements in VLSI technology 
allow very complex algorithms to be constructed in hardware. Miniaturization 
reduces the overall weight of vehicle controllers and also greatly increases 
electronic speed. New techniques in image processing and vision analysis enable 
very complex images to be examined. More details can now be extracted from 
images with these techniques than was previously possible [Refs. 14,15]. New 
computer architectures provide the massive computation power required for real- 
time processing [Refs. 16,17]. Large amounts of sensor data and images can now 
be reduced quickly to facts that are needed for autonomous decision making. New 


techniques developed in artificial intelligence provide more opportunities for 
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autonomy. These techniques are capable of handling more complex knowledge 


representations and manipulations [Refs. 18,19]. 


B. AUTONOMOUS MOBILE ROBOTS 
1. Shakey (1967) 

The Shakey project represented one of the earliest attempts to study 
autonomous navigation using a mobile robot. Shakey was developed by Stanford 
Research Institute to studv the real-time control of a robot system that interacts 
with a compiex environment |Rer. 13]. 

Shakey moved around with two independently controlled wheeis mounted 
on both sides of the venicie. [t had a rotatable "head" which carried a vidicon 
camera wnich provided "sight" to Shakey. This head was also provided with an 
optical range-finder. Several touch sensors were attached around the vehicle for 
collision detection and avoidance. 

An SDS-940 computer was used to control the behavior of Shakey using 
two radio links. One link was used for telemetry and the other link was used for 
transmission of the visual input from the camera to the computer. 

Another significant feature of this early attempt at an autonomous system 
was its man-machine interface. Commands could be given in primitive English 
that was analyzed and translated into the appropriate machine actions by a LISP 
program |[Refs. 20,21]. This feature also included a simple question-answer 


capability. 
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Shakey’s world consisted of a grid model and a property list model. The 
grid model is a hierarchically organized system of four-by-four grid cells. This 
model was constantly updated by the vision system and it served primarily as a 
free space map used for path planning and navigation. 

The property list model kept track of the various characteristics of the 
objects in its worid. Information about each object such as its coordinates. size, 
etc., gave Shakey a better sense of the world. Using this model. Shakey could 
navigate to a xnown object described in the property list. The model also 
orovided information sor coliision-iree navigation around the environment. 

2. DStaniOrad Gaqeieh a 

VThe research work for the Stanford Cart was carried out in the Stanford 
University Artificial Intelligence Laboratory [Ref. 22]. The only sensor installed on 
the cart was a camera remotely linked to a DEC KL-10 computer. The KL-10 
computer functioned as the vehicle controller and also as an image processor. 
After each cart move, it received nine scene images from a slide-mounted camera. 
each taken from a different camera position. Distinctive features were extracted 
from the first image and this information was used with the rest of the images to 
perform a 3-D analysis of the scene in front of the cart. 

The perceived scene was used by the navigation software to compute a 
collision-free path towards the goal. The collision-free path was determined by 


translating obstacles into circles on the floor and moving the cart, which is 


represented by a three meter circle, among these obstacle circles. 
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The Stanford Cart was able to maneuver successfully in a cluttered 
environment. However, it took a very long time to accomplish its mission [{Ref. 
22], typically requiring several hours to move a few tens of meters. This was 
largely due to the lengthy 3-D scene analysis processing time needed to determine 
the next cart move. 

3. Hilare (1977) 

This system was constructed in France at the Laboratoire d’ Automatique 
et d’ Analyse des Systemes in Toulouse. The purpose of the mobile robot was to 
serve aS a testbed for generai research in robotics and in robot perception and 
planning ‘Ref. 23]. 

The Hilare robot had a 3-D vision system consisting of a laser range- 
finder and a video camera. A set of 14 ultrasonic emitters-receivers provided 
range data around the robot for distances of up to two meters, and a variety of 
other sensors provided other information required for autonomous navigation. 

On-board 8085/86 microprocessors were used by Hilare to process sensor 
inputs. These processors were remotely connected to an SEL 32-77/80 computer 

. which handled navigation and coordination. The SEL 32 was in turn remotely 
connected to another larger computer, an IBM 30/33, for higher level planning 
and control. A remote IBM-370 was also used for performing complex analysis 


tasks. 
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4. Robart I (1980) 

This robot was built by LCDR Hobart R. Everett under the supervision 
of Professor R.E. Newton of the Naval Postgraduate School’s Department of 
Mechanical Engineering. The aim of this project was to provide a development 
and demonstration platform for microprocessor-controlled mechanical systems 
‘Ref. 24]. Patrolling was the main role of this robot. It was able to detect a 
variety of household dangers such as smoke. fire. toxic gas. flooding conditions. or 
intrusion. and was capable of then intorming tne user appropriately. 

The Robart [| system moved around on a tricycle wheelbase with tront 
wheei controi. it had a rotating "head" for scanning the environment. One of 
the major and important sensors missing from this robot is vision. Lacking vision. 
it had a forward-looking ultrasonic ranging unit, a long-range near-infrared 
proximity detector, ten short-range near-infrared proximity detectors, tactile 
feelers, and bumper switches. The last two groups of sensors were used for 
collision detection and avoidance. 

To detect a person, the robot had a true-infrared (long wavelength 
infrared) body heat sensor. This sensor had a range of about fifty feet. The robot 
was also able to steer towards the center of a doorway with the help of a near- 
infrared long-range proximity sensor. It also had an assortment of other sensors 
for detecting flooding, fire, smoke and toxic gas conditions. 

A surprising addition to this mobile robot was its speech capability with a 


two hundred and eighty word vocabulary. This allowed the robot to use voice 
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communication to inform the user of any dangerous conditions. It also made use 
of this facility to report some of its internal status information. 

The only computing machinery installed on Robart I was a SYM-1 
microcomputer. This on-board computer used a 6502 microprocessor to which all 
the robots sensors were connected except for the speech synthesizer which had its 
own dedicated processor. 

During normal operation, Robart I moved straight ahead and stopped at 
Various points to perform surveillance. However. when an onstacle was detected. 
it would move to the left or right depending on which was appropriate and then 
continue its straight anead movement. 

5. Robart II (1982) 

Robart II is an improved version of Robart I |Ref. 25). The basic purpose 
of this new robot remains the same as for Robart I. However, not only are there 
more sensors on Robart IJ. but the number of different types of sensors installed 
also has been increased. This machine currently has six ultrasonic range-finders, 
fifty near-infrared proximity detectors, a long range near-infrared range-finder, 
and various other sensors used to detect smoke, fire, toxic gas, flooding conditions 
and intrusion. 

The previous Robart used only one microcomputer for all of its processing 
requirements, which proved to be insufficient. Robart II has eight 65C02-based 
Microcomputers to handle the increased number of sensors and also to provide 


more parallel processes to make it more responsive. 
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The eight microprocessors of Robart II are connected in a hierarchical 
fashion, each with a dedicated function to perform. The head, the drive motors. 
and the vision subsystem are each handled by a dedicated processor. The sonar 
and the speech subsystem are each handled by another hierarchy of two 
processors. Al] these processors. however. work under the direction of the SYM-1 


computer. 


C., AUTONOMOLS LAND VEHICUES 


wb 


1. FMC Corporation Autonomous Vehicle {1985} 

The venicie sed in this project is a 10-ton M113A2 armored personne! 
carrier. which is a trackeca vehicle rather than a conventional wheeled vehicle. 
The vehicle carries an inertial navigation system. a venicie controller computer. a 
sonic imaging sensor. and a master control computer. Beside this, a remotely 
located control trailer contains a Symbolics 3600 Lisp machine for the Planner 
software, a Sun workstation for the Mapmaker-Observer-Pilot, an IBM PC for 
sonic-sensor post-processing, and appropriate communications equipment [Ref. 
26]. 

The FMC vehicle control software consists of five major interconnected 
subsystems that are called Planner, Observer, Mapmaker, Pilot, and Vehicle 
Control [Ref. 26]. Each of these subsystems has a well-defined and important 
function to perform. Together they make the FMC model one of the most 


advanced and successful autonomous land vehicles. 
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The FMC autonomous vehicle world is represented by digitized maps. 
These maps have terrain elevation and feature information that is used by the 
Planner. The primary role of the Planner is to generate segmented "freeways" 
defining free space from the starting position to the destination [Ref. 27]. The 
Planner is also capable of accepting mission requirements to decide the global 
path. Such requirements may include minimizing detection of the vehicle by the 
enemy. Another possibility is to minimize the time or energy involved to 
accomplish the mission. 

The segmented treeway is used by the Observer. The Observer makes use 
of various sensors sucn as a sonic imaging sensor [for obstacie detection and an 
inertial land-navigation system for calculating position and heading. With the 
input from the Planner and data from the sensors, the Observer derives a more 
usable plan for the next subsystem, the Mapmaker. 

The Mapmaker generates the Pilot Map containing the vertices of a 
polygonal representation of the global path border, nearest obstacle borders, and 
sensor visibility limits. This is achieved by combining the Observer’s input with 
the Obstacle Map. The latter is the product of the sonic imaging sensor. 

The Pilot Map is very detailed but also very localized. It is used by the 
Pilot whose main responsibility is to guide the vehicle along an optimum path 
that is determined dynamically. To determine the optimum path, the Pilot 


generates several subpaths that are weighted according to certain criteria. Once 
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the optimal path is picked, the Pilot issues the necessary instructions to the final 
subsystem. the Vehicle Controller. for actual execution. 

A substantial amount of effort has been placed on the problem of obstacle 
avoidance in the FMC program. When an obstacle is encountered, the Pilot 
switches modes. It stops goai-seeking and starts obstac!le-following. When the 
vehicie overcomes the obstacle. it resumes its goal-seeking mode. 

2. Hughes Research Laboratory Autonomous Vehicle (1983) 

The Hughes Research Laboratory autonomous venicie is another state-of- 
the-art autonomous system. Like the FMC model. it too has a modei of the wori!d 
in whicn the autonomous venicie is going to operate. Mission requirements and 
constraints are also accepted by the model to derive a plan for accomplisning the 
mission. Various sensors provide the required information about the environment 
for the vehicle to adapt dynamically to unforeseeable situations. 

The entire system architecture of the Hughes system is based on a 
situation assessment module and an action planning module [Ref. 28]. The 
former uses available knowledge about the behavior and characteristics of a given 
object. Together with the interrelation between the various objects, it tries to 
visualize the surrounding environment. The latter module does the actual 
formulation of various actions required to fulfill the mission. 

The most notable difference of this autonomous vehicle from other 
autonomous vehicle projects is the method of knowledge representation and the 


emphasis on applying artificial intelligence techniques. The system uses three 
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types of stereotyped knowledge representations called special problem solvers. 
scripts and domain-specific production rules [Ref. 28]. 

The special problem solver consists of four path experts that decide which 
path to follow. The script based problem solver is used to provide predetermined 
("canned") plans to solve problems that have stereotyped behavior. The rule- 
based system takes over whenever the script system cannot produce the proper 
actions to handle a situation. 

The four path experts are called Shortest-path. Hide. Feasible-path. and 
Lost-path. Hacn is designed to cater to the requirements of an autonomous 
vehicle in various situations. The Shortest-path expert generates the shortest 
path between two points taking into account the obstacles between the two 
locations. The Hide expert determines a path with the best concealment 
characteristics. This path minimizes the vehicle’s exposure to threats. The 
Feasible-path expert uses heuristics to produce a path between two locations. 
The heuristic procedure of this expert uses the information the vehicle has 
gathered along the path and the information about it’s current environment to 
decide a feasible path for the vehicle to follow. Finally, the Lost-path module 
generates a path for the vehicle to explore and wander around the area when it 
has no path to the designated goal. 

The hardware for the Hughes system includes a DEC 20 computer that 
implements a rule-based system for deciding the proper action for the vehicle to 


follow. Several Z80 computers are used to solve individual specialized problems 
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such as finding the optimal path. Another processor generates commands to the 
vehicle control computer. Vision is handled by an image processing computer. A 
Lisp machine is used for for vehicle control. The vehicle carries a vidicon camera. 
ultrasonic sensors. touch sensors, and infrared ranging sensors. 

3. Martin Marietta Autonomous Land Vehicle (1986) 

The aim of this project is to demonstrate the state of the art in 
autonomous navigation and tactical decision making [Refs. 29.30]. The vehicle 
used. called the ALV {Autonomous Land Vehicie}. is an eight-wheeled all-terrain 
vehicle from Standard Manufacturing, Inc. It is capable of traveling up to 18 
mph on rough terrain and up to 45 mph on improved surfaces. 

Mission goals and constraints specified to the ALV are interpreted by a 
Reasoning Subsystem. The output from the Reasoning Subsystem is a set of 
subgoals to be fulfilled in order to accomplish the mission. The Perception 
Subsystem controls all the sensors and generates a symbolic model of the 
environment for reasoning. The model consists of road boundaries. Moving the 
vehicle along the specified trajectory is handled by the Control Subsystem. 

The Perception Subsystem sensors consist of an RCA color video CCD 
camera and a laser range scanner. The image taken by the camera is processed by 
a VICOM image processor. The output from this image is a set of 2-D edge 
points representing the two road boundaries. To generate a 3-D scene model for 
the Reasoning Subsystem, range information from the laser scanner is used by the 


image processor to compute the road boundaries in 3-D vehicle coordinates. 
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The Reasoning Subsvstem consists of a goal seeker, a navigator, and a 
knowledge base. The goal seeker analyzes the mission given, and using the 
information in the knowledge base derives a sequence of activities for the vehicle 
to execute to achieve the goal. The navigator uses the 3-D model from the 
Perception Subsystem to compute several possible trajectories, and uses two cost 
functions to determine the trajectory for the venicle to follow. 

The pilot, which is part of the Control Subsystem, takes the specified 
trajectory the venicie should follow and converts it into a sequence of steering 
commands to drive the vehicie. 

The hardware architecture used in the ALV consists of an _ intel 
multiprocessor system that has an 80286/80287 master processor. an 80816 
Navigation processor. an 8086 vehicle control processor, and an 8089 multichannel 
controller. The Perception Subsystem is managed by the VICOM image 
processor. However, this architecture will be affected by plans to use a more 
advanced computer, the BBN Butterfly parallel computer, to manage the 
increasing complexity of the Reasoning Subsystem. Another plan is to replace the 
currently heavily loaded VICOM image processor with a CMU WARP computer 


(Ref. 29]. 


D. SUMMARY AND CONCLUSIONS 
In the control of autonomous land vehicles, the need for several high- 


performance and specialized processing systems working in parallel is fairly 
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obvious. Without such elaborate hardware, software, and advanced computer 
architectures. an autonomous vehicle will not be able to fulfill even its most basic 
requirement. namely, to adapt quickly to environmental changes. 

Many varieties of sensors, each capable of providing the vehicle with a means 
to sense the environment in a different manners are extremely important. An 
autonomous vehicles ability to dynamically modify its behavior depends on the 
range and the capability of the various sensors installed in the vehicle. Without 
these sensors. autonomy would be very difficult to achieve if not impossibie. 

The erfect of various gain settings tn the vehicle controller could have a 
significant impact on the perrormance or an autonomous vehicle. With an 
improper gain. it was found in the FMC model that the vehicle fails to behave 
properly or performs poorly [Ref 26). 

In order to avoid the problem of improper gain settings. a computer 
simulation allows the various vehicle controller gains to be adjusted easily. With 
this facility, different types of vehicle behavior can be simulated. The effect of 
these gain settings can be realistically visualized by means of the 3-D graphics 


simulation model. 
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Ii. DETAILED PROBLEM STATEMENT 


A. INTRODUCTION 

In this chapter. the node! used for the 3D graphics simulation is described in 
detail. To assist a reader who has no control theory background. a brief 
description of the purpose of developing a mathematical model and its subsequent 
linearization is given. 


The aim of this research is stated in the foilowing section. This serves a 


Pf 


a 
motivation for developing the graphics simulation. The reader snould bear :n 
mind that the hypothesis used in *his researcn has not and may not De proven 
theoretically correct. The answer to this question requires much more work 
beyond what is presented in this work. 

Many important interactions between the vehicle and the environment when 
the vehicle is moving have been neglected to keep the complexity of the 
mathematical model manageable. However, a short discussion of some of these 
interactions is included to give the reader a better appreciation of the real 
complexity involved. 

The last section in this chapter provides a detailed derivation of the 


mathematical model used. All of the model linearization analysis is also 


presented. 
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B. AIM 

The aim of this work is to examine and study by way of an "out of the 
vehicle windshield" graphics simulation model. a new technique for autonomous 
vehicle steering control. This technique attempts to mimic the way a human 
navigates his vehicle on the road. 

The hypothesis is that a human driver unconsciously divides his route to his 
destination into "chunks" of small interconnecting line-of-sight segments. These 
segments are not »orepared a priori. but instead are built dynamically while 
driving along a road. It is assurmed that t1nconscious planning determines the 
distance of the next road segment from the current vehicle position. A point at 
the end of this road segment is then the driver's unconscious subgoal. 

The location of a subgoal on the road depends on several factors such as the 
speed at which the vehicle is traveling, the road surface condition. the level of 
driving experience of the driver, and the general nature of the surrounding 
environment. The environment refers to situations such as the traffic conditions 
in front or behind the vehicle, the number of lanes available, and any potential 
danger spots ahead such as intersections, road bends, etc. 

This work assumes that near-perfect vision is available for the autonomous 
vehicle and that the road is obstacle-free. These seeming » unreasonable 
assumptions were made to allow the author to concentrate on the aspect of 


unconscious driving rather than on the problems of image and vision processing, 
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and obstacle avoidance, where there are currently numerous research activities 


being carried out by others [Refs. 14-19]. 


feo lLALE SPACE REPRESENTATION 

The aim of studving dynamic system behavior is generally one of gaining an 
understanding of the system. with a view to controlling it to satisfy a reauired 
specification |Ref 31]. A block diagram can be used to pictorially represent the 
system to be controlled. But to perform any analysis. a quantitative description is 
required and this may not be available from a bDiock diagram. A svstem can De 
descriped quantitatively using a set of mathematical expressions which is 
commonly known as the mathematical mode! ot the svstem. The two common 
methods to describe a system quantitatively are the transfer function method and 
the state space method |Ref. 31]. The latter technique is adopted in this work 
because it 1s more appropriate for computer simulation and it is also able to cope 
with more complex systems including nonlinear effects. 

Most systems are inherently non-linear in nature. However, in many cases, a 
linearized analysis can be performed to predict the system behavior and to obtain 
suitable gain values for the actual model. Linearization basically involves 
restricting the values of the system variables to sufficiently small deviations from 
a datum point; i.e., the normal operating point of the system. A linearized 


system analysis of the vehicle steering problem is included in this chapter. 
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D. VEHICLE MECHANICS 
1. Motivation 

There are many complex interactions occurring between a moving vehicle 
and the environment that are ignored in this simulation. Some of these 
interactions are discussed here to provide the reader with some insight into the 
complexity involved. 

2. Resistance to Motion 

Vehicle acceleration arises when there is tractive effort between the tires 
and the road [Ref 22]. However. not all the tractive effors is used to provide 
acceleration: rather. a certain vroportion of this effort !s needed to overcome 
resistance to motion. The main sources of resistance to motion are air resistance. 
rolling resistance, and gradient resistance. 

The amount of air resistance depends on numerous factors. The vehicle 
shape, size and its velocity are some of these factors. The interaction of the tires 
and the road surface give rise to rolling reststance which depends upon factors 
such as vehicle velocity, vehicle load, and the type of road surface. Gradient 
resistance arises only when the vehicle climbs a slope. The amount of gradient 
resistance is directly proportional to the steepness or gradient of the slope it is 
overcoming. 

3. Slip Angle 
When a wheel is rolling, it is acted upon by a side force due to imperfect 


contact between the tires and the road surface. The angular difference between 
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the direction of motion and true wheel rolling direction is called the slip angle 
[Ref. 33]. When a vehicle is cornering, depending on the sign of the slip angle, 
the vehicle may understeer or oversteer. 
4. Brakes 

The amount of braking effort required is related to the load carried bv the 
wheels and the coefficient of friction of the road surface. Another important 
consideration is the location of brakes. When brakes are applied while a vehicle is 
cornering, computation of the braking effort 1s more compiex. This is due to the 


side forces acting on the wheels when the vehicle is cornering. 


E. VISION MODEL 

The vision mode! usec in this graphics simulation is extremely simpie. The 
model consists of a set of road points representing the center of the entire road 
circuit. When the vehicle is operating in the autopilot mode. it "sees" these 
points down the road. one of which is selected to be the new target point for the 


vehicle to steer towards. 


F. SIMULATION MATHEN: . TICAL MODEL 
1. A Simplified Planar Dynamic Model For Manual Control 
The notation used in this work will follow as closely as possible to that 
adopted by Frank and McGhee [Ref. 34]. A top view of the vehicle is shown in 


Figure 3.1. 
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Figure 3.1 Top View Of The Vehicle 
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The vehicle will be confined to a flat road surface. Therefore z = 0, z = 
0, and the position vector can be collapsed to a two-dimensional vector. The 
rotational moment of inertia is ignored. This means that the vehicle is idealized 
to a point mass. To further simplify the model, it is assumed that the velocity 
vector alwavs lies along the vehicle x axis: 1.e., no sideslip angle is allowed. 
Finally. it is assumed that the vehicle turning rate. w. is linearly proportional to 


Y 


the forward velocity and to the steering wheel angle, #6. That is. 
w= os (5 


To caiculate the associated turning radius. R. note that she time to rotate the 


venicie through an angle 27 is 








9 ae 
——— 
on EB k| gz (3.2) 
while the distance traveled in this time is 
d= 27rR =|2| to, (323) 
Thus 
1 
Bid, id - ” 
2r "ke loz| kyl 9 (3.4) 
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This equation shows that large values for k,; correspond to "stiff" steering while 


small values correspond to "sloppy" steering. 
Longitudinal control modeling accelerator control [Refs. 35,36] can be 


approximated by 
a (3.6) 


where z, is the command velocity, which in turn is a function of the accelerator 
depression angle. and 7, is the acceleration time constant. It is easily shown that 


for a step cnange in 2, at t = ty . the resulting velocity profile is 


Combining all of the above results, a suitable state vector for this system 
1S 
L (zp, YE, Cf, w) (3.8) 


If the control vector , provided by the human operator is defined as 


then, from the above analysis, the component form of the state equation is: 


fl) => ap = 2 cosw.— 21a ecosec 4) (3.10) 


(2) = yp = sin — ca) sie) (3-18) 
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noe 2 — — —2(3) > —t(1) (3.12) 
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z(4) =v (3.13) 


For manual control. u(t) is provided by the human operator. Eq. (3.10 - 
3.13) can then be numericaliy integrated and provided to the operator in the form 
of a graphics display to permit him to guide the vehicle around a prescribed 
course. Note that for practical vehicles. both z. and 6 must have upper and lower 
bounas. 
2. Pursuit Navigation and Small Angie Linearization Analysis 


From the previous analysis. we have 


te| 


ty 
(2 
& 
ry 

t 

x 

C9 
Fb 
Qi 


= (Zp, Up, Ev)" 


ul. 


(3.16) 


For autopilot control. in the research of this study, the vehicle forward velocity is 


assumed to be constant. Therefore 
z(3) = 0 (S217) 


One approach to steering the vehicle is to simply aim it directly at the 
current steering point. That is, the vehicle heading could in principle be governed 


by the simple relationship 
w(t) = a(t) (3.18) 


Such a steering law is sometimes called pure pursuit navigation. Obviously, if 
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pure pursuit navigation could be realized, the vehicle would pass directly through 
each steering point. However, this does not fit the model of this chapter in which 
the steering point is at a constant distance d ahead of the vehicle. A potential 


solution to this problem is to differentiate Eq. (3.18) to obtain 


wt) = a(t) Bs) 
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Unfortunatety. referring to Figure 3.1. it can be seen that whenever w = QO, it will 
also be true that 7 = 0. In this case. the vehicle will simpiv move parallel! to the 
road center and will not turn toward it. To remedy this problem. an ‘ntegral 


term can ve added to Ea. (2.19) resuiting in the steering equation 


Referring to Figure 3.1, the "line-of-sight" angle. o. is given 


mathematically by 


os 
o = tan) | ———— (3.28) 
The corresponding line-of-sight rate, 0, can be approximated by 
a{t;) — o(t;-1) 
a(t,) = ] : (3:22) 
by — by 


where j is an index associated with successive computation cycles. Eq. (3.20) will 


be used in the following linearized system analysis. 
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Referring again to Figure 3.1, for the straight road case, and using small 


angle approximations. we have the following: 
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As stated previously. for the purpose of linearized system analysis. it is assumed 
that the venicie steers toward a point located in front of the vehicle at a constant 


distance d where 


d = : Ds (3.329 


The quantity T is called the steering votnt prediciion "ime and is evidently given 
by 
d 
i (3.34) 
e 
Using Eq. (3.33), Eq. (3.32) can be re-written as 
: blue, 50a 
me ie k + — peop Seo 
YE g T YE T YE ( ) 
or 
le ee (3.36) 
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The characteristic equation [Ref. 37] associated with Eq. (3.36) is 


NA+ kA +k) =0 forom 
where 
i a 
ky — ee ye ae (3.38) 
} 
and 
k 
a Be (3.39) 
7 


The corresponding response of the system to initial condition errors 1s. for the case 


Of distinct eigenvalues. 


where A, and A, are the roots of Eq. (3.37), c,; and cy are determined from the 
boundary conditions y(t), y(tp), and tp is the time when autopilot is turned on. 
Critical tee [Ref. 38] results when the eigenvalues A, and A. are 
equal, real, and negative. Critical damping implies the most rapid response 
possible to steering errors without overshooting the road center line in response to 


an initial position error. From Eq. (3.37). the system eigenvalues are 


2 i 
2 
ee ll | -:, (3.41) 
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Since critical damping results when the second term in this equation is zero, it 


follows that 
ae (3.42) 


Substituting Eq. (3.38} and Eq. (3.29) into Eq. (3.42). 
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Solving this equation vields the foilowing relationship: 
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Using tnis reiationsnip in tu. | 3.41). 


From this. the system total time constant, 7,514:, [Ref. 38] is given by 


i Z 


Total — iv ) iy a aa (3.46) 
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which means that vehicle position error will be corrected to about 40% of its 
initial value in approximately 7,,,,, seconds [Ref. 39].. As a specific example, if 
T = 1 is chosen, then k, = 1, A = —1, and 7,,,,, = 2. Another example, if T = 2 
is chosen, then k, = 0.5. A = —0.5, and 7,,,,,; = 4. This completes the derivation 


of parameter values for this example of a vehicle steering equation. 
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3. Proportional Navigation With Integral Term 
In Chapter V. it is shown that while pursuit navigation performs as 
predicted by the above linearization for driving on a straight road, it tends to 
steer to the inside of turns on a curved roadway. One way to solve this problem 


is to introduce an additional gain term. k.. which multiplies o. This result is a 


form of proportional navigation |Ref. 40] with the addition of the integral term 
introduced in the previous section of this chapter. 
In order to determine a value for *. suitable for driving on a curved road. 


it should be noted that the resuiting vehicle guidance law is: 
ea ho — k,\o—Ww) (S.44 | 


M@aetiat the condition for steady turn is w =o. Thus. in such a situation. 


e 


o=p=k.o + k,(o—y) (3.48) 
SO 
1—-k. 
a) = = eed (3.49) 


From Figure 3.1, the road/vehicle equation for a curved road is 
Zp + (yp — R)* = R?* (3.50) 


or 


tp’ + yp’ — 2ypR = 0 (3.51) 
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(3.52) 


which can be approximated by 
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Using small angle approximations, 
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and thus. on a curved road with radius R. 
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Since, in a steady turn, 6 = v, combining Eq. (3.49), (3.55), and (3.56) it follows 
that 
l—k. - 
fle ae 
= = — 3.57 
2R kee aie a7 
(3.58) 
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Eq. (3.58) is one of the constraints for this model. 
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4, Linearized Analysis For Proportional Navigation 


Using smal] angle approximations. with the inclusion of k, and the road 


curvature, Eq. (3.36) becomes 
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The characteristic equation associated with this resuit is 


i K,A ~ ky = 0 (3.01 | 
where 
k. 
ey ae k, (3762) 
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Substituting constraint Eq. (3.58), it follows that 
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Thus, for the critical damping condition, 
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(3.66) 
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(3.72) 
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k= -2= (27 +41] (3.73) 
Oo 
Solving Eq. (3.73) with the constraint k. > 0, 
ae 0.828 (3.74 ] 
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As an example of the application of the above results, if A = — 0.5 is chosen, then 


k, = 0.294, T = 1.17, k, = 0.828. and 7,,;,; = 4. For another example, if T = 0.8 


Peemosen, then k, = 0.43, \ = — 0.73, k, = 0.828. and 7,,4; = 2.7. 


G. SUMMARY 

The aim of this study is established. The assumptions made have been 
delineated so that a mathematical model can be developed for the realization of a 
computer simulation to study both manual and automatic steering of a highway 
vehicle. 

In the next chapter. the main concern is the actual implementation of the 3D 


graphics simulation using the mathematical model derived in this chapter. 
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IV. COMPUTER SIMULATION MODEL 


A. INTRODUCTION 

Various methods of impiementing the mathematical mode! developed in ‘she 
previous chapter were examined during the formulation of this study. It was 
finally decided that the best way to perform the simulation would be to have a 3D 
color grapnics animation model which can be ariven Dv the user. One of the most 
suitable machines available at the Naval Postgraduate school for this purpose is 


the [RIS (Integrated Raster imaging System) color graonhics <vstem. A _ brier 


io 


escription of this graphics system configuration and its hardware features is 
given in this chapter. 

In what follows. much attention is devoted to the man-machine interface of 
the simulation. The user can drive the simulation with a mouse attached to the 
graphics system. He can also use the keyboard to turn on or off certain 
information displays concerning the status of the simulation. 

A complete description of all the modules and supporting files which are used 
for the simulation is provided in this chapter for those who plan to study the 
simulation in detail. A user guide is also included, though it is not absolutely 


necessary to read it wholly in order to run the simulation. 


AT 


B. IRIS-2400 WORKSTATION 
1. Hardware And Overall System Description 

The IRIS graphics workstation installed in the Naval Postgraduate School 
Graphics Laboratory is a high-performance. high-resolution 1024 x 768 color 
graphics svstem. A combination of custom VLSI circuits. conventional hardware. 
firmware. and software provide a very powerful set of graphics commands to 
perform 2D and 3D graphics Rets. 41-44}. There are currently two IRIS systems 
installed in the ‘aboratory. Both systems are Unix-based machine but one system 
nas a Motorola \{C68010 processor with 5MIB of CPU memory while tne cther 
system has a Motorola {C68020 processor with 6MB or CPU memory. The 
configuration ot both [RIS-2400 workstations consist of an electronic cabinet with 
two 72 MB Winchester disk drives. an 83-key up-down encoded keyboard. a 
three-button mouse. a high-resolution 60 Hz non-interlaced 19-inch RGB color 
monitor, 32 bitplanes, a hardware matrix multiplier Geometry Pipeline. and a 
floating point accelerator. 

The IRIS hardware consists of three pipelined components. It is this 
design structure that makes the IRIS different from many other graphics systems. 
Many systems tend to implement their graphics capabilities with software that is 
cheaper. However, these systerns have much lower efficiency and much lower 
performance. Also with these systems, the 3D color graphics simulation model 
would require significantly more programming effort and time, not considering the 


fact that the final overall performance may not be suitable for this simulation. 


48 


The three pipelined components in the IRIS system are the applications/graphics 
processor. the Geometry Pipeline, and the raster subsystem [Ref. 41]. 

Graphics commands are processed by the applications/graphics processor. 
Commands are first sent through the Geometry Pipeline. which performs matrix 
transformations on the coordinates. clips the coordinates to normalized 
coordinates. and scales the transtormed, clipped coordinates to screen coordinates. 
The raster subsystem accepts the output of the Geometry Pipeline. It fills in the 
pixels between the endpoints or the lines. fils in the interiors of polygons. converts 
character codes into Dit-mapped cnaracters. and performs shading, deptn-cueing. 
and hidden surtace removal. The system maintains a color vaiue [for each pixe! :n 
its bitplanes which determines the image color on the monitor. A total of thirty- 
two bitpianes allow color graphics images to be presented in a very realistic way. 

2. Programming Language 

The IRIS system software is written in C, but the commands in the 
graphics Library are callable in C, FORTRAN. Pascal, and Extended Common 
Lisp (ExCL). However, at the time when the simulation was implemented. only 
Pascal and C were available. Consequently, C was chosen to be the programming 
language for implementing the simulation. One of the reasons for this decision 
was the programming experience of the author with C and the other was to 
Maintain compatibility with the IRIS system software. However, C is not without 
its disadvantages. One of problems with C is that it is a weakly typed language. 


This tends to make software development more frustrating and time consuming. 
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This frustration could have been considerably alleviated if a strongly typed 
language like Pascal had been used. 
3. Graphical Objects 

This is a group of drawing commands used to defined a geometric model 
or an object. The advantage of using these commands is that the graphical 
objects can then be treated as a single entitv which can be moved, scaled. rotated. 
or combined with other graphic objects to form more complex objects. 

+. Double Burering 

Tne screen image in an [RIS system is stored in a set ot bitplanes. Eacn 
bitplane provides one Dit of storage per pixe!. An RGB value is associated with 
each pixe! which determines the color and the brightness or the pixe!. This value 
is made up of three eignt-bit intensity values - one for red, one for green. and one 
for blue. 

The bitplanes can be used in either of the two modes, single buffer or 
double buffer. In the single buffer mode. up to twelve bitplanes can be used to 
handle the image color and the rest can be used for z-buffertng , a technique used 
to remove hidden lines and surfaces. The problem with single buffering is that 
the image on the screen is simultaneously updated and displayed. This means 
that incomplete or changing picture may appear on the screen. 

In double buffering mode, the bitplanes are divided into two portions, 
called front and back buffers. The purpose of having two buffers is to have one 


buffer being updated while another buffer is being displayed. The benefit of this 
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arrangement is that a changing or incomplete image will not appear on the screen. 
This is important in certain applications such as motion animation. The 3D 
graphics simulation uses the bitplanes in double buffering mode. 
5. Coordinate Transformation 

In order to manipulate graphical objects. coordinate transformations are 
required |Rer. 41). When defining the object. it is convenient to cnose a point to 
be the object origin and to then build the object around this selected reference 
point. The space wnich the object occupies is called ooject space. 

The object space must De translormed into worid space w'.en a group oF 
Objects is to be displayed together. Since the world space can be viewed trom 
various directions and orientations. another coordinate system called eye spuce is 
required to specify how the world space is to be viewed. Finally, this eve space 
must be mapped into screen space which is a 2-D coordinate system for displaying 
the objects on the graphics screen. 

Four types of transformation commands are available on the IRIS to 


perform the various mappings described above: 


0 Modeling transformation commands, such as rotate, translate, and scale, 
transform the coordinate system of objects. 


o Viewing transformation commands, such as polarview and lookat, place the 
viewer and eye coordinate system in world space. 


o Projection transformation commands, such as perspective, window, ortho, 
and ortho2, transform eye space to the screen coordinate system. 


ol 


o Viewport transformation commands, such as viewport and scrmask. define 
the position of the rectangular region on the screen to be used for displaying 
the image. 


C. USER GUIDE 


To run the graphics simulation, just enter the following command: 


carsimu 


It takes a snort time for the computer to read the roadmap into the memory. 

The simulation begins with the aisplay as shown in Figure t+.1. As can be 
seen. the top haif of the grapnics display ts an "“out-of-the-windshieid”™ view of the 
world and the lower naif or the display is the vehicle dashboard display area. 

On the extreme ieIt of the dashboard display is some information about how 
to drive the vehicle. This display area shows that pressing the three mouse 
buttons simultaneously terminates the simulation. 

Pressing the right mouse button is equivalent to stepping on the accelerator of 
a conventional vehicle except that every mouse click increases the desired speed 
by a fixed increment of four kilometers per hour. Pressing the middle mouse 
button is similar to stepping on the brake of a conventional vehicle except that 
every mouse click decreases the desired speed by a fixed decrement of four 


kilometers per hour. Pressing the left mouse button, which is the third and last 


button, stops the vehicle. 


Aejdstq uorwepomrg sotyderp [°p einsty 


eoiy AeTdstqd uorzems1ojuyT “sg TeouM Sutzr994Gg “FP 
Teueg Butusrey «2 sseduopD ‘€ 

Taeyouoply ‘g asney Teng “Sf 

Ioqyouopssdg ‘gc Teueg djeyq ‘T 


—_ awe ee SSS oe Co cum ge GR oo 


3S Hl 
2 SS ee . e 


MOTA PLOTYSputM-S4L-FO-INO 


bX 
© 


Moving the mouse to the left or to the right corresponds to turning the 
steering wheel of a vehicle. The steering wheel turning rate is controlled by the 
speed the mouse is moved towards the left or the right. 

Besides using the mouse buttons for driving the vehicle. the keyboard keys are 
used to toggle various information displays or to reset certain dashboard displays. 
Pressing h or H on the keyboard stops the simulation temporarily and the whole 
dashboard area is used to display additional information about the various key 
functions. 

The tueil gauge indicates the arnount or fuel left in the venicie. When the fuel 
runs out Detore the whole circuit is compieted. the simulation stops and a message 
is displaved to inform the driver or the condition. 

The compass is located on the top center of the dashboard display. This 
shows the vehicle heading angle. Following this is the steering wheel display 
indicating the position of the steering wheel. the speedometer showing the current 
velocity of the vehicle, and the odometer recording the total distance traveled. 
The first three indicators are especially helpful for manual driving since it allows 
the driver to "feel" the situation and make more appropriate corrections if 
necessary. In real driving, these indicators are not as important because the 
driver’s kinesthetic senses provide him with information concerning the steering 
wheel and the various forces acting upon him. 

On the extreme right of the dashboard display is the warning panel. When 


the vehicle is not moving, the brake light is turned on. When the engine is 
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warmed up, the temperature light shows yellow and when it overheats. the light 
turns red. The most important part of the warning panel is the danger light. 
This area blinks when the vehicle moves too close to the edge of the road. An 
alarm will also be given if it is switched on by the user with one of the keys on the 
keyboard. 

The jast area on the dashboard display is called the inrormation display area. 
The main purpose of this area is to show some key technical data used for the 
current simulation run. This area. bv default. is turned off and it can de turnea 
on w:th a key on the kevboard. 

A clock indicating the date and time of dav 1s displaved on the top lert of the 
grapnics display. Again this can be turned otf with a kev. When the venicle ts 
operating in the autopilot mode. a biinking indicator is displayed on the top 


center of the graphics display. 


D. MODULE DESCRIPTION 
1. Carsimu.c 
This is the main module of the entire graphics simulation. It sets up the 
system by initializing all the local and global variables and the graphics facilities. 
After setting up, the actual simulation is controlled from this module. Figure 


4.2-4.8 show the flowcharts of this module. 
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Figure 4.2 CARSIMU.C Flowchart 
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Figure 4.4 Main Simulation Loop Flowchart (Part 2) 
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Figure 4.5 Main Simulation Loop Flowchart (Part 3) 
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Figure 4.6 Main Simulation Loop Flowchart (Part 4) 
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61 









Compute & 


Display Fuel 





‘Display Out Qf) 


Yes 
0 —$sae fuel £& «Turn | 


won tT  Adiwo Sauer 
{ee 


Figure 4.8 Main Simulation Loop Flowchart (Part 6) 
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Ze Gircultec 

This module has three main functions. The first and primary function is 
to build the road used in the graphics simulation. The road is built with four 
straight segments of equal width and length. These segments are connected 
together by three road curves to form a open-ended rectangular circuit. Tne 
length and wiath of the straight segments can be varied individually. The radius 
of the road curves can also be individually modified. 

The second function of this moquie is to "paint" all the road marks on 
the surtace of the road. There are three types of road marks - white arrows. 


" ail 


white strips and wording on snMe road surtace. The final function is to "erect' 
the signboards along the road. 
3. Find-subgoai.c 

The function of this module is to search for the next subgoal for the 
vehicle to steer towards when the vehicle is operating in the autopilot mode. This 
module uses the road map generated by the module map.c to compute and 
determine the next subgoal. 

Instead of searching for the subgoal only when the vehicle is in the 
autopilot mode, the subgoal is constantly being computed and selected once the 
vehicle starts moving. There are two reasons for doing this. The first being that 
it provides a general solution to ensure that the subgoal is always in front of the 


vehicle. This is done by making sure that the very first subgoal is chosen in front 


of the vehicle. Subsequent subgoals are constantly recomputed and selected as 
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the vehicle moves so that the subgoal will always remain in front of the vehicle. 
This simple solution works in the simulation model because the vehicle always 
starts from the same position and heads in the same direction. 

The second reason. which is the more important one, is that of providing 
a subgoal quickiv when the autopilot is turned on. When the subdgoal is not 
constantly being recomputea and selected. then if the autopliot is turned on [for 
the first time very far down the road, a significant and noticeable delay arises due 


to the need to searcn for a subdgoal starting from the beginning of the road. 


Another situation where there is sucn a delay is when the autopilot its turned of 
and on over a ‘tong distance. In the latter situation. the subgoal has to be 
computed trom the location where the autopilot was last turned off. 
4. Map.c 

This is the only module that works independently from the rest of the 
system. Its basic role is to generate the road map that is used for subgoal 
computation and selection. Though it works independently. it has to be given the 
same road description as that used for building the road in the main simulation 
module. 

There are a number of road parameters that can be modified. These are 
the road width. road length. road curve radius and interval size. The last 
parameter determines how far apart road center line points are spaced in the list 


of points available for steering subgoals. Evidently, the smaller the interval size, 


the greater is the number of points generated to represent the road. For the 
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results presented in Chapter V, the road points available for vehicle steering are 
stored with a spacing of 1 meter between successive points. The output of this 
module is a file containing the map of the entire road. This file is called roadmap. 
5. Other.c 
There are many routines in this module. Each routine builds a graphical 
object sucn as the sky. clouds and mountains. There are aiso a few supporting 
routines which are called by circuit.c to build the road used in the simulation. 
These supporting soutines build the roac surtace. curves. arrows anc signbDoaras. 
pase De 
When the key h or H is pressed. the lower half or the grapnics screen that 
displavs the vehicle dashboard is used to display help inrormation. This module 
controls the content of the help information. 
7. Letter.c 
This routine was developed J. Artero and R. Kirsch and modified by L. 
Williamson. This module creates all the upper-case Roman alphabet except for 
G, Q, V, W, X and Z. With the graphics translate and rotate command. the 
appropriate letters are selected and positioned to form the wording on the surface 
of the road. 
8. Integrate.c 
The Euler-Heun numerical integration method is implemented in this 


module [Ref. 45]. When the vehicle is driven in manual mode, the driver controls 
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the steering wheel with the movement of the mouse. However, when the autopilot 
is in control. the steering wheel angle for the dashboard display is computed. 
9. Display.c 
The whole dashboard display is created with this module. The vehic @ 
dasnboard is dispiayed on the lower haif of the graphics screen. Figure 4.1 shows 
the various parts of the dashboard dispiay. 
10. Road.h 
User defined constants in C programming are extremeiv important. This 
feature not oniv makes software modification easier. but aiso improves program 
readabilitv. Besides the system denned constants that can be accessed by 
including the include Ale. gi.h. user derined constants are kept in road.h. This fle 
also contains any additional user defined type sucn as Dimension. 
11. Roadmap 
This is the file generated by the module map.c. It contains the roadmap 
that defines the center line of the road used by the simplified vision model. 
Without this file, the simulation will not run. 
12. Makefile 
The make facility in UNIX [Ref. 42] is a very useful feature. It helps solve 
a lot of program administration problems associated with large software projects 
involving many modules. One capability that it provides is to automatically 


recompile only the files that have changed. The make feature is driven by an 
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special file call Makefile. This special file defines the files that make up the entire 


program. 


teeorBCIAL NOTES 
This section highlights some of the important decisions made in the 
simulation program that must be understood by readers wno may intend [to 
modify and improve the simulation. 
ees Sranch Cut 
This feature is required tO overcome tne problem or discontinuity when 
the arctangent function used in the main moduie crosses the 180° boundary. The 
solution to this problem adopted in this work assumes that the maximum vehicle 
neading error never exceeds 45° and therefore places the arctangent branch cut at 
—45° rather than at the usual 180° location. This alteration permits the road 
center line to turn 270° without the vehicle encountering a discontinuity in o or 
w. 
2. Convention Difference 
One of the issues that caused much programming difficulty initially is 
that the x, y, and z axis convention adopted in the mathematical model 
developed in Chapter III differs from that of the IRIS graphics implementation in 
that the graphics z axis in screen coordinates is directed inward. Anyone wishing 


to modify the programs of this work must be aware of this difference. 
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3. Roadmap Size 
The size of the array used in the program for holding the roadmap. that 
is. the road center line, is initialized to 3000 points. This may not be sufficient for 
a roadmap with a smaller interval or when the present road circuit is extended. 
Another point to note is that the z coordinate of the road point is included so 
that an uneven road can be set up without mucn software modification. 


Currently. the z coordinate 1s set to zero. 


EF. SUONIVIAR AND CONCH US iM. 

The entire graphics simuiation mode! is written in a manner that ailows easy 
modification and expansion. One of the major pronpiems witn software 
development is to control the rippiing effect of future code updates. Much 
attention was devoted to this aspect when the software system of this study was 
designed. 

With the 3D color graphics simulation model, many experiments can be 
carried out involving both human and autopilot driving. The results of a number 
of such experiments are documented in the next chapter. The source code of the 
entire simulation model is included in the appendix for those who need to access 


to it for more detailed understanding or modification. 
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V. EXPERIMENTAL RESULTS 


Pee iNT RODUCTION 

Many simulation runs were carried out with different model characteristics to 
test the validity of the hypothesis and the correctness of the mathematical mode! 
used. The results of the 3-D simulation runs were captured. scaled. and formated 
into 2-D plots jor documentation and discussion. 

To obtain the 2-D piots. a special modification was made to the main 
simulation moduie. The purpose of the modification was *7o capture the venicie 
DOSITION 2S 1b Moves and +o record !ts deviation trom the road center line. The 
information is stored in two files that are also scaled. The scaling is based on the 
background, figure upon which this information is overlaid to obtain the desired 
plot. 

The figures in this chapter are produced with a very flexible and easy-to-use 
graphics package called OZDRAW [Ref. 46]. Basically, the desired background 
such as the outline of the road, is generated with OZDRAW according to some 
scale. The information given by the modified module discussed above is then 


used by OZDRAW to overlay the vehicle positions onto the road outline. The 


combined image is then labeled and printed for documentation. 
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B. DESCRIPTION OF EXPERIMENTS 

The entire simulation test track consists of four 400m straight road segments 
connected by three road curves with 80m radius to form an open-ended 
rectangular circuit. However, in most cases. not all of the circuit is used for 
capturing the experimental results. Rather. all but a few of the experiments were 
carried out for a short segment of the entire circuit which included a 200m 
segment of straight road followed by a road bend and then another stretch of 
about 150m ot straignt road. 

in all the exper:ments. the simulation begins by setting the velocity to tne 
desired value and putting the venicie 5m om the road center line. For autopilot 
driving experiments, the autopilot is also activated. Except for Figure 5.3. Figure 
5.4, and Figure 5.15, the simulation stops when the vehicie crashes or when it 
successfully overcomes the bend and it is about 150m down the second segment of 
the straight road. The results of Figure 5.3 and Figure 5.4 are obtained by driving 
the vehicle in the autopilot mode for 200m on the straight road. Figure 5.13 is 
generated by autopilot driving around a 270° loop with a radius of 80m. All of 
the experiments use the nonlinear mathematical model for the vehicle developed 
in Chapter III. A comparison between the linearized model and the nonlinear 
model is carried out with two experiments to show their relationship and the 


accuracy and usefulness of the linearized model . 
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C. MANUAL DRIVING 

When the simulation was’ first developed. the mouse buttons were used to 
manually drive the vehicle; i.e., pressing the left mouse button moved the vehicle 
to the left and pressing the right mouse button moved the vehicle to the right. 
This was found to be an uncomfortable wav to drive the vehicle. The method 
that the simulation now uses is found to be much better. It simply involves 
moving the entire mouse to the left or to the right to steer the vehicle to the left 
or to the right respectively. This method of driving was tound to be more natural 
and more closely resemble actual driving conditions. 

Typical results for human driving are shown in Figure 5.1 and 5.2. In Figure 
5.1. the vehicle velocitv is 50 km/hr and at this speed human performance is 
clearly good. When the vehicle velocity is increased to 75 km/hr. shown in Figure 
5.2, it was noted that performance deteriorated rapidly, especially when going 
around the road curve. In fact, control is only marginally possible. When 
attempting a cornering at this speed, several trials had to be eel out before a 
plot was obtained. Several attempts to manually drive the vehicle at 100 km/hr 
were made, but all were unsuccessful. It should be noted that the dots on these 
plots as well as all other figures of this chapter are generated at a rate of 
approximately 6 Hz and therefore they are more spread out at higher vehicle 


speeds. 
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D. COMPARISON OF LINEARIZED AND ACTUAL MODEL 

The next two experiments were conducted to demonstrate the effectiveness of 
using linearization theory. In these perme the vehicle was driven by the 
autopilot on a 200m straight road using the pursuit navigation model. For each 
experiment. two runs were made. The first run used the 4th order nonlinear 
model of Eq. (3.10) to (3.13) with o and o calculated from Eq. (3.21) and Ea. 
(3.22) respectively. The second run used the linearized model where o and o were 
computed with the linearization of Eq. (23.24) and a. (2.25) respectively. The 
results of these “wo runs were overiaid to obtain Figure 5.3 and Figure 35.4. 
Figure 5.3 used 7’ = 1 and &, = 1 resulting in A = —1. This means that the 
system should be able to correct about 60% of its deviation from the center line in 
two seconds. Figure 5.4 used J = 2 and k, = 0.5 which means that A = —0.3. In 
this case, the time required to correct the same amount of deviation is doubled to 
four seconds. These predictions match the results obtained in both figures. It is 
also observed that in both experiments, the linearized model used is a very 
accurate approximation of the nonlinear model. Moreover, the good agreement 
between the analytical solution and the numerical solution in both cases provides 
a measure of confidence that the simulation program is correct. It also shows that 
the sampling rate of 6 Hz adopted in this work is adequate for accurate numerical] 


integration of the simulation model differential equations. 
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Figure 5.4 Vehicle displacement from road center line 
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E. PURSUIT NAVIGATION 

The next three figures show the performance of the pursuit navigation model 
using various vehicle velocities. Figure 5.5 shows that at 50 km/hr, the vehicle 
was able to keep to the center line of the road quite well while turning a corner. 
Cornering is still not a problem when the vehicle is traveling at 100 km/hr as 
shown in Figure 5.6. But at 150 km/hr. Figure 5.7, the vehicle cannot keep itseif 
on the road when turning the bend due to its inability to keep to the center of the 
road. 

Using the same pursuit navigation model. another set of experiments was 
carried out. In this set of experimments. 1e prediction time was doubled to 2 
seconds. This experiment. as shown in Figure 5.8 and Figure 5.9. shows that the 
autopilot performance dropped dramatically. Due to the longer prediction time, at 
50 km/hr, the vehicle tends very much towards the inside of the road as 
compared to Figure 5.5. At 100 km/hr, the vehicle could not make it around the 
bend because it is predicting too far ahead. However on a straight road, the 
prediction time does not seem to matter. This corresponds closely to the author’s 
concept of human driving. When we are driving on a straight road, we are 
normally more casual than when we are trying to bring the vehicle around a road 
bend; that is, we appear to shorten or lengthen our prediction time according to 
the road conditions and the driving environment instead of utilizing a constant 


prediction time as in this simulation. 
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F. PROPORTIONAL NAVIGATION 

The pursuit navigation model was improved with another gain term added to 
the vehicle guidance law. This made it into a proportional navigation model 
whose performance is illustrated by Figures 5.10 through 5.12. Comparing Figure 
5.10 to Figure 5.5. it can be seen that the proportional navigation model was able 
tO maintain its position on the road center line more diligently. The importance 
of this is that the vehicle is now capable of turning the road bend at 150 km/hr 
without crashing as in Figure 5.12. This was not possible at the same speed with 
the pursuit navigation model. Figure 3.7. 

Another important observation is the svystem’s response to deviation. Based 
on results derived in Chapter [I]. Figure 5.5 to Figure 5.7 should have a total time 
constant of 2 seconds whereas Figure 5.8 to Figure 5.12, Figure 5.15 and Figure 
5.16 should have a total time constant of 4 seconds. As seen in these figures, they 
match the predicted preformance. 

Figure 5.13 shows a performance comparison between the proportional 
navigation model and the pursuit navigation model when the vehicle is going 
around a 270° loop. As predicted by the analysis of Chapter III, the pursuit 
Navigation steering law produces a steady displacement of the vehicle toward the 
inside of the turn. This effect is eliminated when proportional navigation is used 


with k. = 0.828, again as predicted by linearized system analysis. 
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G. EFFECT OF VARIOUS ROAD POINT SAMPUING Ries 

The last set of experiments carried out was to examine the effect of different 
sampling frequencies at which road steering points are selected when the vehicle is 
operating in autopilot mode. All the autopilot driving experiments conducted 
previously were done with the steering point being selected every cycie. Figures 
39.14 through Figure 3.16 show the results obtains when new steering points are 
chosen after every 3 cvcles. 5 cvcies and 7 cycles respectively with a 1.17 second 
prediction tline. Comparison of these figures with Figure 5.14 shows that choosing 
steering DOINts iess often actually helps the vehicle to negotiate curves. This may 
seem surprising initially. but in tact snould be expected since reducing the road 
sampling rate also reduces the average prediction time. There is of course a limit 
to the extent that the sampling rate can be lowered since the steering point must 
not be allowed to pass under the vehicle. For the present example. since T = 1.17 
seconds, the maximum interval for road sampling is 7 control cycles (because, as 
previously stated, the vehicle steering loop was operated bv a 6 MHz rate for all 
simulation experiments). 

While the above analysis seems to say that the apparent human strategy of 
driving toward one point for several steering cycles is effective, one negative result 
of this approach was noted. This was that the steering wheel motion was more 


jerky than in earlier simulations in which a new steering point was selected on 


every control cycle. Again, this is not surprising since reducing the average 
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prediction time should tend to cause the system to become somewhat 


underdamped according to the theory of Chapter III. 


H. SUMMARY 

The results in this chapter show that the hypothesis about the unconscious 
behavior of human driving is reasonably weil in agreement with realitv. It aiso 
shows that the mathematical mode! developed in the earlier chapter is a useful 
mode! for mimicking this unconscious benavior. However. mucn more work is 
needed to ODLain statistical information about how human gain vaines and 
prediction times vary «vith driving conditions Defore any degree or confidence can 
be altacned to the nvypotnesis of this work. Regardless of the resuits of such a 
study. however. ‘he hypothesis used for unconscious human Dehavior in steering 


clearly provides a viable basis for autopilot design for autonomous vehicles. 
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Vi. SUMMARY AND CONCLUSIONS 


moe SUMMARY 

This research work differs from most previous research work in the area of 
lateral controi of autonomous venicles in the sense that steering iaws have not 
generally been derived explicitly from a model of human task performance. 
Rather. mucn of the current research focuses mainiv on vision. sensors. planning, 
navigation. and obstacle avoidance. So far as the author knows. none has 
explored the pDehavioral aspects or human ariving which could provide some 
different insights into possible approaches to autonomous navigation. 

As observed at the start of this work, human driving can be divided into two 
distinct levels: that of conscious and unconscious behavior. This work is 
concerned entirely with studying and modeling of the unconscious aspect of 
human driving. 

Another important product of this work is the development of a 3-D color 
graphics simulation model. This model can be modified, enlarged and enhanced 
to incorporate other related research work in the future. With this model, the 


experiments are more interesting and realistic than using simple 2-D data plots as 


has been done in many previous simulation studies. 


93 


B. CONCLUSIONS AND POSSIBLE EX TuNsilek. 

In this work. all the different subsystems such as the vision subsystem, the 
vehicle control subsystem, etc., are treated all together as one system. This is 
manageable because of the various simplifying assumptions made in the 
mathematical model for vehicie and driver behavior. One direction to enlarge this 
research work Is to deveiop a more sophisticated vision model. The present vision 
mechanism is too simpie and assumes perfect vision capable of "seeing" a point 
down the road for the vehicle to steer towards. A Detter mode! couid use a more 
elaborate aigorithm and tecnniques sucn as texture and color analysis to 
determine the various road features and to estimate the road edge location. 

Another possibile extension to this work is to study the conscious aspect of 
human driving. An example of this conscious behavior would be the ability to 
stop the vehicle appropriately when the vision subsystem "sees" a stop sign along 
the road or an obstacle large enough to prevent the vehicle from going ahead 
further. 

In conclusion, the author hopes that this research work can serve as a testbed 
and motivation for a more elaborate and comprehensive study into the behavioral 
aspects of human driving. This could have a significant impact on the 


development of viable autonomous vehicles in the future. 
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APPENDIX — SOURCE PROGRAM 


A. CARSIMU.C 


* 
i, 
This is the main program of the entire vehicle simulation 
program. To recompile this program Just issue the command 
Makenile. 


* / 


f 
j 


zinclude "road.h" 


Pee erie ee ce ok ke ke Ke ce eK KKK KKK KK EK KK Er eK KKK Kee exe eee xtxn ae = 


© oO BAL Dae Ah. AT 1LONS 


KRRKK CK KKK KR KKK KKK KE KKK EK KK SSE KKK KEKE KK KEKE KEK EK KEK 


* DO NOT remov any of these deciarations. 
They mav be used in the supporting programs. * 


Tag transl4, transl, transl2, transl1, transl, trans22: 
Tag housellooktag. houseltranstag, houselscaletag; 
Tag houselooktag, housetranstag, housescaletag; 
Tag dangertag, temptag, belttag, braketag; 

Tag odotagl. odotag2, odotag3, odotag4; 

Tag fuell, roadlooktag, skylooktag; 

Tag steerwheeltag, terrainllooktag; 


Coord latri/3]/2), ratri[3]j2]; 


float fuelbar,speedbar; 

float fuelquant = MAXFUEL; /* Maximum fuel available */ 
float heading xpos = 429.5; /* Heading indicator position * / 
float speedinc = 1.0; /* Speed increment/decrement */ 


Device keypressed; 
Boolean start = TRUE;  /* Start of program flag Py 
eo 
Larger turning response gain corresponds to "stiff" 
steering and lower value corresponds to "sloppy" 


steering. Large velocity gain corresponds to sedan 
automobile and smaller value corresponds to sport car. 
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Operator has contro] over steer wheel angle and speed 
using the mouse. 


Car time is the integration timer. 
*/ 


float 
float 


state vector! 5); 
emd psi dot; 


Hoat heading angle rate gain = 1.0: 

Hoat vetocity time consant = 9.0: 

fHoat turning response gain = 0.02: 

Hoat neading angle gain = On 

float steer wheel angie = 0.0; /* Unit is radian * 
Hoat prediction time = 1.0; y* Unit is second * 
float steer inc =O. 10: * Unitds radianee 
doat car time =(00) 

Hoat dettat = in 

oat speed —nU. 


"7 


* TRIS ailow sucn a large array onlv if it is gtobal ~ 


Joat roadmap,;50001!3; 


Dimension Bendradius! = 30.0: 
Dimension Roadwidth <= 16.0: 
Dimension Roadlen = 400-0. 
Angle Fov = 1000; /* Field of view 100 deg */ 


main() 


{ 


[FFT EREEEEEA RR ELE LAR EEE LEE ERE ESAS TAT CR AK Oe eee 


LOCAL DECLARATIONS 


Se ERE ERR ST ET TSS a: | is 7 


int old sampling cycle =i 

int sampling interval wie /* Steering point sampling rate */ 
int prev mousex = 250; /* Previous mouse x position */ 

int where = 1, /* Steering point location */ 

int distance = 0; /* Distance travelled */ 


char thousandc[2], hundredc|2], tenc/2], unitc|2/, temp_string|15,; 
int i, no coord, new sampling cycle, mousex, cal _mousex; 
int count, unit, ten, hundred, thousand, no of round; 


FILE *fp; 


oO. 


Oro: 


float sigma dot 


float tolerance 


100 


float old sigma =a 
float sigma =O 


float prediction distance; 
float temp, temp]; 
float gx, gy, gz; 


extern long time();_ /* System clock */ 

char timec|10]; /* Car time in char format */ 
long clocktime; ( *forclock value ~/ 

Shar clockc; 


Boolean showclock = TRUE; /* Display clock flag *. 


Boolean showtimer = FALSE; /* Display integration timer *, 
Boolean alarm = FALSE; /* Off road warning flag */ 

Boolean bell = FALSE: /* Turn ott danger alarm */ 

Boolean debug — tek 9 Lurmo debug into ~/ 

Boolean autop = FALSE: '* Turn off debug info */ 

Boolean ebrake = FALSE; * Emergence brake flag *: 
Dimension consumption = 1.0: ‘* Fuel consumption * 

Dimension crashdown = 0.0: * Off-road display flag * 
Dimension fueldown = 0.0; /* Fuel depleted display flag *, 
Dimension headingdeg = 0.0; ‘* Heading in degrees */ 
Dimension headingrad = 0.0; * Heading in radians * 

Dimension rdistance =0.0; ,* Distance travelled *’ 

Dimension vd = 100.0; /* Viewing distance */ 

Dimension mps_to_kmph = 3.6; /* m/s to km/hr conversion * / 
Dimension rad to deg = 360/(2*PI); /* radian to degree conversion */ 


Coord crashx 
Coord crashy 


512.0; /* X viewport coord to detect off-road */ 
385.0; /* Y viewport coord to detect off-road */ 


il 


Coord warnxl] = 212.0; /* X viewport coord to warn off-road */ 
Coord warnx2 = 812.0; /* X viewport coord to warn off-road *, 
Coord warny = 385.0; /* Y viewport coord to warn off-road */ 


Colorindex colors|1];_| /* Array to store color of crash spot * / 
short nopixel = 1; /* No of pixel to detect off-road */ 


Coord cx, cy, cz; /* Current viewing point */ 
Coord rx, ry, rz; /* Reference point a 
Coord pz, px; /* Last viewing point */ 


Object speedometer, fuel, steerwheel, signboard, sky, mountain; 


Object terrainl, odometer, warning, heading meter; 
Object road, help, arrow, house, housel; 


NRCan ge TTT ERAT EES SEAR ER AE LEASES * 
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Soo ay av INITIALIZA T Poss 


SESE ESET ORES LL AS AE SRE ESSE ee ee aaa 


/* Initial state vector of the automobile */ 


state vector|1| = 0.0; /* initial z coord */ 
state vector|2) = 0.0; /* initial x coord */ 
state vector|3. = 0.0" /* initlalivelocit. 
state vectori4, = 0.0; /* initial heading */ 


Cx =10, OGcy — cz —s0 0: 
PX = 0,00 ry = 0.0077 —<1.d- 
count = unit = ten = hundred = thousana — 


ginit(); 

doublebuffer(); 

gconfig{): 

cursoff(): 

qdevice(KEYBD): 

viewport(0, XMAXSCREEN., 0. YMAXSCREEN);: 
orune2(0/0: 1022-0007 1o7.0): 


bhnk(10, CYAN. 255, 0, 0): 
BbOXZi( 540. 0. (Oto De On) 


mapcolor(MOUNTAIN, 199, 128. 63); 
mapcolor(MOUNTAINI, 210, 150, 0); 
mapcolor(FIELD, 5. 190, 20); 
mapcolor(SKY, 50, 8, 155); 
mapcolor(WARN, 125, 0, 0); 


mapcolor(CHMWALL1,118,76,0); 
mapcolor(CHMWALL2, 146,114,0): 
mapcolor(WINDOW,0, 141,205); 
mapcolor(SIDEROOF, 188,50, 14); 
mapcolor(FRAME,118,50,14); 
mapcolor( WALL, 164,111,0); 
mapcolor(SIDEW ALL, 146,94,1); 
mapcolor(ROOF’,148,50,14); 


/* Dark Grey */ 
mapcolor(ROOF1, 100,100,100); 
i Tent Grey */ 
mapcolor(FRAME1,0,60,60); 

/* Light Grey *, 
mapcolor(SIDEW ALL1,150,60,60); 
yh Pink = 
mapcolor(WALL1,160,60,60); 


setvaiuator(MOUSEX, 250, 0, 500); 
setvaluator(MOUSEY, 250, 0, 500); 
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noise({MOUSEX, 10); 


a Ee RES EERE REE 


Peer ALL LHE OBJECTS 


KKK KK KK KK EE KEK KKK KKK KKK KK KKK KKK KE KK KKK KKK KKK KKK KE KEE / 


makethespeedometer(&speedometer); 
makeheading(&heading meter); 
makesteerwheel( &steerwheel); 
maketheodometer(&odometer}; 
maketerrain1(&terrain1): 
makewarning(&warning}: 
maketheroad(&road)}; 
makehousel (&housel}; 
makehouse(&house); 
makethesky(&sky); 
makehelp({&help}; 

makefuel{ &fuel); 


/* Display the introductory image * 
welcome(); 


a Cie 8 ar TERESA SES 


RekeA D ROADMAP 


KKK KEK KEKE EEE KK KEK KEKE KKK KKK KEKE KKK EK KK KKK KK RK KK EEK KKK KKK KEKE K KKK / 


/* Read road map into system */ 


Beg — fopen("roadmap","r")) == NULL) 


printf("Cannot read roadmap. \n"); 
return(-1)}; 
} 
else 
for (i = 0; !feof(fp); ++i) 
fscanf(fp,"70f %f %f", &roadmap/i]|0}, &roadmapii){1,, 
&roadmap({i]/2)); 
no coord = --1; 


setbell(’1’); 
ringbell(); 
setbel]l(’2’); 
ringbell(); 


NN ie TEE CE STR EE SEERA REAR RARER EES 


MeeIfTIALIZE BUFFERS 
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KK KK KKK KKK KKK RK KKK KKK KKK KK KKK RR KKK KKK KKK KKK KR KK KKK KK KKK KKK KEKE 


/* Wait till a mouse is pressed. */ 
while(getbutton({MOUSE3) == 0}; 
color(BLACK); 

clear(); 

swapbuffers(}; 

clear(); 

swapbuffers(): 


[RRR EEE ERS ERE EEE RR Ee Ee ee dee 


MATIN, SIMULA T LON SECO 


KKKKKKKKKK KEK RK KKK KKK EK KK KKK KKKEEKKKKEKK KKK KKK KEKKEKKKE EK KK KK 


while(TRUE) 
{ 


new sampling cycle = count, sampling interval: 


DZ = CZ: 
pX = CX; 


clocktime = time{(long *) 0); 
clocke = ctime{&clocktime}; 


;* To display clock? * 


if (keypressed == ’c’|| keypressed == ’C’) 
if (showclock) showclock = FALSE; 
else showclock = TRUE; 


/* Sound alarm around 2m before off the road */ 


cmov2(warnxl, warny); 

readpixels(nopixel, colors): 

if (colorsiO| != BLACK && colors|/0) != WHITE) 
alarm = PRUE 
else alarm = FALSE: 


if (!alarm) 
{ 
cmov2(warnx2, warny); 
readpixels(nopixel, colors); 
if (colors|O} != BLACK && colors|0} != WHITE) 
mliarm = LARUE, 
else alarm = FALSE; 


} 


/* Check if the vehicle is off the road 
IMPT : Assume road surface is black 
and surface signs are white */ 
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cmov2(crashx, crashy); 

readpixels(nopixel. colors); 

if (colors[O| != BLACK && colors|/0! != WHITE) 
crashdown = -1000.0; 


rz = - (vd*cos(state vector|4|)} + state vector|1]): 
rx = vd*sin(state vector/4|) + state vector|2); 


if (keypressed == ’q’ || keypressed == ’Q’) 
if (autop) 


autop = FALSE; 


prev  MmouUsex — MoOusex, 


else if (state vector|3) > 0) autop = TRUE; 


#ifdef DEBUG 
for(i = 1;1 <= SYSTEM ORDER: —-1) 
switch(ij 
{ 
ease li 
printf("N: %.2f "state vector: 1'); 
break: 
ease 2: 
printi("y: %.2f "state vectors2.): 
break: 
case J: 
printf("Velocity: %.2f ",state vector 3)*mps to _kmph); 
break; 
case 4: 
printf("Heading: %.2f\n",state vector 4 * rad to deg); 
break; - ae 
} 
#endif 
cz = -state vector|1'; 


cx = state vector|2]; 

/* Check if keyboard pressed. Keys pressed are queued. */ 
checkkeybd(}; 

mousex = getvaluator(MOUSEX); 

if (!lautop && !ebrake} 


if (getbutton(MOUSE]1) && getbutton(MOUSE2) 
&& getbutton(MOUSE3}} 


/* Exit Program */ 


break; 
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else if (getbutton(MOUSE1) || (keypressed == ’a’ | 
keypressed == ’A’)) 
{ 


if (speed < 190) 


{ 
Start = Foalok, 
speed = speed + speedinc; 


else speed = 190.0; /* Top Speed */ 


} 


else if (getbutton(MOUSE3) || (keypressed == ’e’ 
keypressed == ’E’)) 


t 


x 


/* Emergency brake *, 
ebrake = TRUE: 
“state vectors = 0.0: 
speed = 0.0: *, 


} 


else if (getbutton(MOUSE2)!' (keypressed == *b’ 
kevypressed == °B’}} 


{ 


x 


Decrease speed 


if (speed > 0) 
speed = speed - speedinc; 
else speed = 0.0; 


} 
} /* if (lautop) */ 


if (!ebrake && state vector/3 > 0) 


{ 


prediction distance = state vector 3! * prediction time; 


Le 

"where" is passed to find subgoal so that searching 

need not always start from the beginning of the road. 

The z and y convention in the graphics system is reversed. 
Also the sign is going in the opposite direction. So 
compensate before passing into find subgoal. 


Ti 
where = find subgoal(roadmap, no coord, where, tolerance, 
prediction distance, cx, -cz, 0.0); 
} 
if (lebrake && (autop && old sampling cycle < new sampling cycle 


|| !autop)) 
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old sampling cycle = new sampling cycle: 
if (where < 0) 
{ 
/* Stop completely and remove autopilot * / 
ebrake = TRUE: 
/* state vector|3] = 0.0; 
speed = 0.0; */ 
autop = FALSE: 
} 


{ 

gx = roadmapiwhere|i0); 
gy = roadmapiwhere|/ 1); 
gz = roadmapiwhere) 2); 


} 


else 


} 


“ Convention difference: Z-axis in graphics is Y-axis in 
mathematical model. Also Z-axis is negative when moving 
into the screen wnich therefore must be converted to 
positive for our calculation. ~ 


temp = -cz: 
sigma = atan2((gx-cx),(gy-temp)); 


,” Sigma _dot(0) = 0 */ 
if (count == Q) old sigma = sigma; 


/* This is 45 deg branch cut to handle the discontinuity 
when arc tangent function crosses PI and -PI */ 


if (sigma < -(PI/4)) sigma = 2*PI + sigma; 


#ifdef DEBUG 
mimi ex 7.2! cx Yo.2f gy %.2f cz %.2f",ex, cx, gy, cz); 
printf(" sigma deg %.2f\n",(sigma/(2*PI))*360); 
#endif 


sigma dot = (sigma - old sigma) /deltat: 


cmd psi dot = (heading angle rate gain * sigma dot) + 


(heading angle gain * (sigma - state vector|4])); 
if (autop) 
steer wheel angle = cmd psi dot/ 
(turning response gain * state vector(3]); 


old sigma = sigma; 


if ('!ebrake && !autop) 
{ 
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/* Manual Driving * / 


cal mousex = mousexX - prev_mousex: 
steer wheel angle = steer wheel angle — (float) cal mousex/100; 
prev mousex = mousex; 


} 


compute new state(autop); 


* / 
f 


/* Clear the vehicle window 


viewport(0. XMAXSCREEN, 385. YMAXSCREEN); 
color{FIELD): 


clear({); 
/* Clear the display panel */ 


viewport(0. XNIAXSCREEBN2 0. 380}: 
coior{ WHITE): 


clear(): 
Reset viewport 
viewport(O, XKMAXSCREEN, 0. YMAXSCREEN); 


* Caiculate the velocity for emergence brake * 
if (ebrake) 
/* every 16.0 km/hr or 4.0 mph will take the 
vehicle one additional cycle to stop. */ 


state vector 3 = state vector 3! - 4.0; 
speed = state vector 3); 
if (state vector.3 < 0) 


ebrake = FALSE; 
state vector|3| = 0.0; 
speed = 0.0; 
} 

} 


/* Calculate distance travelled */ 

rdistance = rdistance+sqrt((cz-pz)*(cz-pz)~(cx-px)*(cx-px)); 
if (keypressed == ’o’|| keypressed == ’O’) rdistance = 0.0; 
distance = (int) rdistance; 

thousand = distance/1000; 

hundred = (distance - thousand * 1000) / 100; 

ten = (distance - hundred * 100 - thousand * 1000) /10; 

unit = distance - ten * 10 - hundred * 100 - thousand* 1000. 
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if (unit == 10) { unit = 0; +-ten; } 

if (ten == 10) { ten = 0; ++hundred; } 

if (hundred == 10) { hundred = 0; ~+thousand: } 
if (thousand == 10) thousand = 0; 
sprintf(timec,"%5.2f ,car_time); 
sprintf(thousandc,"%d" thousand); 
sprintf(hundredc,"%d" hundred); 
sprintf(tenc,"%d" ten); 

sprintf(unitc,"%d" ,unit+—); 


SevisP LAY HELP PANEL *, 
callobj{help); 
eee DIT SKY * 


editobj{sky); 
objreplace(skvlooktag): 
lookat(cx.cy,cz.rx.ry.rz.0.0): 
closeob)(}; 

callobj(sky): 


; EDIT TERRAIN * 


editobi({terrain1); 
objreplace{ terrain ilooktag): 
lookat(cx.cy,cz.rx,ry.rz.0.0): 
closeobj(); 

callobj(terrain1); 


f EDIE ROAD */ 


editobj(road); 
objreplace(roadlooleag); 
lookat(cx,cy,cz,rx,ry.rz,0.0): 
closeobj(); 

callobj({road); 


/* EDIT HOUSES */ 


editobj{ house); 
objreplace{houselooktag); 
lookat(cx,cy,cz,rx,ry,rz,0.0); 
objreplace(housetranstag); 
translate(-80.0, 0.0, -50.0); 
objreplace(housescaletag); 
scale(0.40, 0.40, 1.0); 
closeob}(); 

callobj(house); 


editobj(house1): 
objreplace(housellooktag); 
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lookat(¢x,cy,cz-rx ny n2.0. 0). 
objreplace(houseltranstag); 
translate(-30.0, 0.0, -10.0); 
objreplace(houselscaletag); 
scale(0.50, 0.50. 1.0): 
closeob)(); 

callobj(house1): 


editobj(house1); 
objreplace(house llooktag): 
lookat (cx Cy ¢z.2x.ry-tz-0.0). 
objreplace(houseltranstag):; 
transiate(-30.0. 0.0. -15.0}); 
objreplace{house Iscaletag): 
scale(0.50, 0.50, 1.0): 
closeobj({); 

callobj(housel): 


editopj( house}: 
opjreplaceinouselooktag}: 

lookatl Gm. Cy -C2.0X.cV 77.0.0); 
obireplace| housetranstag}: 
transiate{ 100.0. 0.0. -Roadlen: 2}: 
obireplace(housescaletag}; 
scale(0.50. 0.50. 1.0): 

closecb}{); 

callobj(house); 


editobj( house): 
objreplace(houselooktag): 

lookatl ex cy cz rxeny 620-0) 
objreplace(housetranstag); 
translate(-40.0, 0.0, -Roadlen - 100.0); 
objrepface(housescaletag); 

scale(0.80, 0.80, 1.0); 

closeobj(); 

callobj(house); 


editob)j( house 1); 
objreplace(housellooktag): 
lookat(cx,cy,cz,rx,ry.rz.0.0); 
objreplace(houseltranstag): 
translate(300.0, 0.0, -Roadlen - 55.0); 
objreplace(house Iscaletag); 
scale(0.50, 0.50, 1.0): 

closeobj(}; 

callobj(house1); 


j/° EDIT STEERING WHEEL) / 


editobj(steerwheel); 
objreplace(steerwheeltag}; 
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rotate((int) -(steer wheel angle * 10 * rad_to deg). ’2’): 
closeobj(); 
callobj(steerwheel); 


/* EDIT ODOMETER */ 


editobj(odometer); 
objreplace(odotag]); 
charstr(thousandc); 
objreplace(odotag2); 
charstr({hundredc); 
objreplace(odotag3): 
charstr(tenc); 
objreplace(odotag4): 
charstr(unitc}; 
closeobj(): 
callobj(odometer): 


if (showclock} 
‘ 
color( WHITE); 
cmov2i({ 100, 750); 
SNAUStPiClockc}; 


eclot BLACK}: 
} 


if (autop) 
{ 
color(CYAN); 
emov2i(400, 750); 
charstr("AutoPilot Mode"); 
color(BLACK); 


} 


/* TESTING AREA *, 


if (keypressed == ’z’|| keypressed == 72’) 
if (debug) debug = FALSE; 
else debug = TRUE; 


if (debug) 


cmov2i(575, 280); 
charstr("Command Speed (km/h) "); 
sprintf(temp_string,"%%.2f" speed * mps_to_ kmph); 


charstr(temp_ string); 


cmov2i{575, 250); 
charstr("Steering (degree) "); 


sprintf(temp string,"%%.2f" steer wheel angle * rad to deg): 


charstr(temp_ string); 
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fe: emov21{575, 220) 
charstr(" Mousex "): 
sprintf(temp_string,"%d",cal_mousex); 


charstr(temp_ string); 


cmov2i(575, 180); 

charstr("Turning Response Gain "); 

sprintf(temp_ string,"%.3f".turning response gain); 
charstr(temp string); 


cmov2i(5i5, 150); 

charstr("Heading Angle Gain "); 

sprintf(temp string,"%.cf".heading angle gain); 
charstr(temp_ string); 


CIMMov alate. 1204, 

charstr("Prediction Time "): 

sprintf(temp string."%%.2f". prediction time}: 
charstr{ternp string): 


1 
; 


 EDttat IME a: 


if (kevpressed == ’t’ keypressed == ’T’) 
if (show timer) showtimer =. ALSE: 
else snowtimer = TRUE: 


if (showtimer) 
{ cmov2i(575, 310): 
charstr("Integration: "); 
charstr{timec); } 


/* EDIT WARNING INDICATOR */ 


if (state vector|{3) > 0) 
{ editobj(warning): 
objreplace(braketag);: 
color(WARN); 
if (alarm) 


if (keypressed == ’s’|| keypressed == ’S’) 
if (beil} bell = FALSE; 
else bell = Eur. 
if (bell) 
{ 
setbell(’2’); 
ringbell(); 


objreplace(dangertag); 
color(CYAN); 
} 


else 
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objreplace(dangertag); 
color(WARN); 


/* ENGINE WARMING UP */ 


if (count < 1000) 
{ objreplace(temptag): 
color{WARN)}; } 


* ENGINE REACHED NORMAL TEMPERATURE * 


if ((count > 1000) && (count < 5000}) 
{ objreplace{temptag}: 
color(YELLOW); } 


‘* ENGINE OVERHEATING *° 


if (count > 5000} 
{ objrepiace({temptag}: 


color(RED); } 


objreplace{ beitiag}): 
color{ WARN}: 
closeobj{); } 

else 


Pp BRAKE SIGNAL FOR CAR STOP “j 


editobj{warning); 
objreplace(braketag); 
color(RED); 
closeobj(); 


callobj(warning): 


/* EDIT HEADING INDICATOR */ 


/* Compute heading using vehicle state vector */ 


if (state vector|4) < 0.0) headingrad = 2*PlI+state vector|4); 
else headingrad = state vector 4); 

no of round = (headingrad*180.0/PI) /360.0; 

headingdeg = headingrad*180.0/PI - (float) no of round*360; 


editobj(heading meter); 

objreplace{transll1); 

translate(heading xpos-20.0-4.5*headingdeg. 4.0, 0.0); 
closeobj(); 


callobj(heading meter): 
/* EDIT SPEEDOMETER INDICATOR *, 


/* 2.5 factor is for converting to the dashboard display */ 


speedbar = 181.0 - state vector/3] * mps to _kmph * 2.5; 
editobj(speedometer}; 

objreplace(transl4}; 

translate(0.0, speedbar. 0.0): 

closeobj()}; 

callobj(speedometer}: 


= EDIT PULL CAUGES 


Stop = no consimption: . 


~ Speed above 100 : consumption is 20% higher * 


if (scate vector 3) > 0.0) 
if {state vector 4' < 100.0} 

fuelquant = fuelquant - consumption: 

else fuetquant = ruelquant - i.2*consumoption: 
fuelbar = fuelquant, MAXFUEL*320.0— 14.0: 
if (fuelquant < 0.0) fueldown = -1000.0: 
editob) (fuel); 
objreplace(fuel1); 
rectf(106.0,14.0,149.0.fuelbar); 


closeob}(); 
callobj(fuel); 


/* EDIT CRASH INFO DISPLAY FOR OFF-ROAD *, 


pushmatrix(); 
pushattributes(}; 


translate(0.0.crashdown,0.0): 
/* Set all warning lights when crash */ 
if (crashdown == -1000) 
=. = FALSE; 
editobj(warning}; 
objreplace(braketag); 


color(RED); 
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bell = FALSE; 
objreplace(dangertag); 
color(RED); 


objreplace(temptag); 
color(RED); 


objreplace(belttag); 
color(RED); 


closeobj(): 
callobj(warning): 


} 


color(RED}: 
recti(0.0.1285.0.1023.0.1767.0): 


color(BLACK}; 

emov21(570.1576): 

enarscr(''CRASH"): 
emov21(270.1560}: 


emarstr;’ OFF THE ROAD"); 


emov21(370.1544): 


Smametr( PUSH ALL THREE MOUSE BUTTONS TO EXIT"): 


popattributes(); 
popmatrix(); 


y “EDIT CRASH INFO DISPLAY FOR FUEL DELETION */ 


pushmatrix(); 
pushattributes(); 


translate(0.0,fueldown,0.0); 


color(MAGENTA),; 
rectf(0.0,1385.0,1023.0,1767.0); 


color(BLACK): 
cmov2i({370,1576); 
eoarstr("STOP"): 
cmov2i(370,1560); 
charstr("FUEL DEPLETED"); 


cmov2i(370,1544); 
eharstr("PUSH ALL THREE MOUSE BUTTONS TO EXIT"): 


popattributes(); 
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popmatrix(}; 


swapbuffers(); 
7 COUML. 


} /* while loop */ 


color{(BLACK); 
clear(); 
swapbuffers(}; 
clear(): 
swapbuffers(); 
finish(); 


gexit(); 


7 mains. 


CRE XKEKRKRKR KR SER KEKE KKK KEK KK KKK KKK KK KT KK SCTE KEK KK cK KK eK. ex SS Se 


Conon Cane Sani Oe ie) 


1 6 Sm OR om SKK Som ER) eS Se Se OK Oe See eee ce oe Re Oe EK. Sk ok: ke Ge CE OR SE SR Oo mom) Sek ce cet Ok en ee ie ee 


/* Keyboard keys can be used to controlled steer wheel angle. 
Keys pressed are queued whereas tne mouse Is not. 
Keys increase tne angie ov a smaller amount. 


checkkeybd() 
{ 


keypressed = NULL; 


if (qtest()} 
{ 


qread(&key pressed); 


/* Display help information */ 


if (keypressed == ’h’|| keypressed == ’H’) 
help(); 


/* printf("%d\n" .keypressed); *, 


} /* checkkeybd *. 
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ee Circuit.c 


as 

Build the entire road circuit. 
*/ 

#include "road.h" 


extern Tag roadlooktag; 

extern float Roadwidth, Roadlen; 
extern float Bendradius1: 

extern Angle Fov: 


[RRR HK KK KK KKK RK KK KOR KK RR KE KK KR KK KK KK KK KK KK KK KK 


PeeeeED THE RALLY CIRCUIT 


fk ok kok ok oe eh he rh KKK EK KKK TTR KS RR KK SKK KS CTT Ke KKM KCK KC CT Kx 


maketheroad{road) 

Object “road: 

{ 

Dimension temp. 1: 

Dimension high =a 
Colorindex signbg = YELLOW: 
Colorindex upsign = RED: 
Colorindex rightsign = BLUE: 


II 


*road = genobj(); 

makeob}(*road): 

pushmatrix(); 

pushviewport(); 

viewport(0, XMAXSCREEN, 385, YMAXSCREEN); 
setdepth(0,1023); 

perspective(Fov, 1023.0/385.0, 0.0, 1023.0); 
roadlooktag = gentag(): 

maketag(roadlooktag): 

lookat(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0): 


en ER REE RE 


MRST STRETCH OF ROAD 


ae. TEESE / 


surf(0.0, 0.0, 0.0, Roadwidth, Roadlen, BLACK); 


ie 
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Build the sign "START" 


* i 
/ 


temp = -d.9; 

color( WHITE): 

pushmatrix({); 

translate(temp + 4.0. 0.0, 0.0); 
rotate{-900,’X’); 

letter(’T’, BLACh);: 


popmatrix(}; 


color{ WHITE): 

pushmatrix(): 

translate(temp — 2.0. 0.0, 0.0}; 
rotate{-900,’X’): 

letter(’R’, BLACK): 


popmatrix(); 


colori WHITE): 
pushmatrix{ |}: 
translatettemp. 0.0. 0.0): 
rotate,-900. X°); 
letter(’A’. BLACK): 
popmatrix|); 


color( WHITE): 

pushmatrix(}; 

translate(temp - 2.0. 0.0, 0.0): 
rotate(-900,’X’); 

letter(’T’, BLACK), 


popmatrix(); 


color( WHITE): 

pushmatrix(); 

translate(temp - 4.0, 0.0, 0.0); 
rotate(-900,’X’): 

letter(’S’, BLACK), 


popmatrix(); 
is 


Build the sign "TURN" before the bend 


color( WHITE): 

pushmatrix(): 

translate(-2.0, 0.0, -(Roadlen - 5.0)); 
rotate(-900,’X’); 

letter(’N’, BLACK); 


popmatrix(); 
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color( WHITE); 

pushmatrix(); 

translate(-4.0, 0.0, -(Roadlen - 5.0}); 
rotate(-900,’X’); 

letter(’R’, BLACK); 


popmatrix(); 


color( WHITE); 

pushmatrix(); 

translate(-6.0. 0.0, -(Roadlen - 5.0)); 
rotate(-900,’X’); 

letter(7U’, BLACK); 


popmatrix(); 


color(WHITE); 

pushmatrix(); 

translate(-8.0. 0.0, -(Roadlen - 5.0}); 
rotate(-900.’X’); 

letter(°T’. BLACK); 


popmartrix(); 


Build a series of arrow 


for (temp = 8.0; temp < Roadlen: temp += 40.0} 
{ 
pushmatrix(); 
translate(0.0, 0.0, -temp)}; 
rotate(-900,’X’); 
polyarrow(0.7, 1.2, 0.0, WHITE); 
popmatrix(); 


fe 
Create Ist uparrow signboard 


* / 


pushmatrix(); 

translate(10.0, 0.0, -5.0); 
signb(1.9, 2.5, 3.0, signbg):; 
popmatrix(); 

pushmatrix(); 

translate(10.0, high, -5.0); 
polyarrow(0.7, 1.2, 0.0, upsign); 
popmatrix(): 
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Create 2nd uparrow signboard 


* | 
/ 


pushmatrix(); 

translate(-7.0, 0.0, -(Roadlen/3.0)); 
signb(1.9, 2.5, 3.0, signbg); 
popmatrix(); 

pushmatrix()}; 

translate(-7.0, high, -(Roadlen,3.0)); 
polyarrow(0.7, 1.2. 0.0. upsign): 
popmatrix(); 


1 


First road bend 


pushmatrixt }. 
translate{ Bendradiusi - Roadwidth: 2. 0.0. -Roadlen): 
rotate{-900. ’X’): 
bend(): 


popmatrix({}: 


x 


Build Ind right turn signboard 


x 


pushmatrix(): 

translate(7.0, 0.0. -(Roadlen-5.0)); 
signb(1.9, 2.5, 3.0, signbg); 
popmatrix({); 

pushmatrix(): 

translate(6.3, 4.0, -(Roadlen-5.0)); 
rotate(-900,’Z’); 

polyarrow(0.7, 1.2, 0.0, rightsign): 
popmatrix(); 


Te ei en ee eee 


SECOND STRETCH OF ROAD 


CERES EER ELS ALS AS SEE REE EES / 
é 


pushmatrix({); 
temp = Bendradiusl - Roadwidth/2; 
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translate(temp. 0.0, -Roadlen - temp); 
rotate(-900. ’Y’); 

surf(0.0, 0.0, 0.0, Roadwidth. Roadlen. BLACK); 
popmatrix(); 


i 
Build a series of road strips 


*K 


j 
for (1 = temp + 8.0; 1 < Roadlen: 1 —= 20.0) 


pushmatrix{(}: 

translate({i, 0.0, -Roadlen - temp}: 
surf(0.0. 0.0, 0.0. 3.0. 1.0, WHITE); 
popmatrix{)}; 


t 
j 


faa » is 1 is 
Create urd ilparrow signboard 


x 


ousnmatrix{ ); 

transiate(temp — 50.0, 0.0. -Roadlen - temp - roadwidth): 
rotate(-900,’Y’); 

signb(1.9, 2.5, 3.0, signbg);: 

popmatrix(); 

pushmatrix(}; 

translate(temp + 50.0, high, -Roadlen - temp - Roadwidth): 
rotate(-900.’Y’): 

polyarrow(0.7, 1.2, 0.0, upsign); 
popmatrix(}; 


a 
Second road bend 
i 


pushmatrix(); 

temp = Bendradiusl - Roadwidth/2 + Roadlen:; 
translate(temp, 0.0, -Roadlen); 

rotate(-900, ’X’); 

rotate(-900, ’Z’); 

bend(); 


popmatrix(); 


ia 
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Build 2nd right turn signboard 
me 


pushmatrix(); 

translate(temp - Roadwidth. 0.0, -Roadlen - Bendradius1); 
rotate(-900,’Y’); 

signb(1.9, 2.5. 3.0, signbg); 

popmatrix(); 

pushmatrix(); 

translate(temp - Roadwidth. +.0. -Roadlen - Bendradius1l - 0.7); 
rotate{-900,’Y’); 

rotate(-900. Z’); 

polyarrow(0.7. 1.2. 0.0, rightsign); 

popmatrix(}; 


ee oy em ae ce ie ai cao ee a ee ac Rc oe 


THIRD STRETCH OF ROAD 


SEK MR KR ERK KEK RRR KEE KE ee KEK CK YK RK KKK 


pusnmatrixt}; 

temp = 2 ~ Benaradiusi - toaawidth — Roaaien: 
translatejtemp. 0.0. 0.0): 

surf(0.0, 0.0, 0.0, Roadwidth, Roadlen, BLACK); 
popmatrix(); 


im 


Create a series of arrows 


rh 
for (i = Roadlen; 1 > 5.0; 1 -= 20.0) 


pushmatrix()}; 

translate(temp, 0.0. -1); 
rotate(-900,’X’): 

rotate(-1800. ’Z’); 

polyarrow(0.7, 1.2, 0.0, WHITE); 
popmatrix(); 


- 
Create 4nd uparrow signboard 


* | 


pushmatrix(); 

translate(temp ~ Roadwidth, 0.0. -Roadlen + 10.0); 
rotate(-1800,’Y’); 

signb(1.9, 2.5. 3.0, signbg): 

popmatrix(); 

pushmatrix(); 

translate(temp ~— Roadwidth, high, -Roadlen + 10.0); 
rotate(-1800,’Y’); 

polyarrow(0.7, 1.2, 0.0, upsign): 

popmatrix(); 


/* 
/ 


Third road bend 


x 


/ 
pushmatrix()}; 
temp = Bendradiusi - Roadwidth: 2 — Roadlen: 
translate/temp. 0.0. 0.0); 
rotate{-900. “X°); 
rotace(-i800. °2’): 
bend(}; 


popmatrix(); 


(RK KK KK RK KK KK KKK KK KKK RK KK KKK KKH 


FOURTH STRETCH OF ROAD 


KKKKK KKK KKK KK KKK KKK KK KKK KKK KKK 


pushmatrix(); 

temp = Bendradius1 - Roadwidth/2: 
translate(temp, 0.0, temp): 

rotate(-900, ’Y’); 

surf(0.0, 0.0, 0.0, Roadwidth, Roadlen, BLACK); 


popmatrix(); 

i 

Create a series of arrows 

a 

for (i = temp + 10.0; 1 < temp + Roadlen; i += 20.0) 


pushmatrix(); 

translate(i, 0.0, temp); 
rotate(-900,’X’); 

rotate(900,’Z’): 

polyarrow(0.7, 1.2. 0.0. WHITE); 
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popmatrix(); 


} 


Create 5nd uparrow signboard 
=, 


pushmatrix(): 

translate(Roadlen, 0.0, Bendradiusi — 2.0); 
rotate(-2700,’Y’): 

Signi t.9) 2.97 6.0. Sign be): 

popmatrix(); 

pushmatrix():; 

translate(Roadlen, high. Bendradius! — 2.0): 
rotate{-2700.’Y’}: 

polyarrow(0.7. 1.2. 0.0, upsign): 
popmatrix{): 


> 


"STOP" sign defore tne -na of circuit 


* 


temp — lho: * Bendradius!: 
color( WHITE); 
pushmatrix(): 
translate(temp, 0.0, 70.0): 
rotate(900,’Y’); 
rotate(-900,’X’); 

letter(’P’. BLACK); 


popmatrix(); 


color( WHITE); 
pushmatrix(}; 
translate(temp, 0.0, 75.0): 
rotate(900,’Y’); 
rotate(-900,’X’); 
letter(?O’, BLACK); 


popmatrix(}; 


color( WHITE); 
pushmatrix(); 
translate(temp, 0.0, 80.0); 
rotate(900,’Y’); 
rotate(-900,’X’); 
letter(’T’, BLACK); 


popmatrix(); 
color( WHITE); 
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pushmatrix(): 
translate(temp, 0.0, 84.0); 
rotate(900,’Y’); 
rotate(-900,’X’): 
letter(’S’, BLACK); 


popmatrix(); 


popviewport({); 
popmatrix({); 
closeobj{); 

} /* maxetheroad * 
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C.  Integrate.c 


ie 
Runge-Kutta 2nd order or Euler-Heun numerical integration 


ef 
#include "road.h" 


extern float heading angie rate gain. velocity time consant: 
extern Hoat turning response gain. heading angle gain: 
extern float steer whee! angle. speed. state vector!5i; 

extern float car time. deltat, cmd psi dot: 


Se a i i A ee ee 


PON Gea a OS 


CK KCK ERK ewe EEE CERRO KR ES 


compute new statetautod| 


Booiean 2utop: 


doat xcapio:. xdot 3: 
inte): 


derivative(state vector, xdot, autop): 
for (i = 1;1<=SYSTEM ORDER, —-+1i) 
/* Euler prediction * / 
Xcap|i) = state vectorji + xdotji' * deltat; 


car time = car time — deltat; 
derivative(xcap, xdot, autop); 
for (1 = 1;1<=SYSTEM ORDER; -—+3) 
/* Trapezodial correction */ 
state vector|i) = (state vectori + xdoti 
* deltat + xcapii})/2.0; 


} /* compute new state */ 


(|KO OK RK RR OK OR ORK KOK KR KORO ORO OK ROK KOK KK KR KKK KKK KK KK EK KKK KKK KKK KKK KKK KEK 
/ 


DERIVATIVE 


FARES ES EERE LAREN AREER RE AEE Ee ee ee ee nr 


derivative(work vector, xdot, autop) 
Boolean autop. 
float work vector),, xdot||: 
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{ 


xdot|1) = cos(work vector/4|) * work vector|3}; 
xdot|2| = sin(work vector|4|) * work vector|3; 
if (!autop) 
xdot|3| = - (1/velocity time consant) * work vector|3| 
+ (1/velocity time consant) * speed; 


* 


else 
xdot'3| = 0; /* no acceleration for autopilot *, 


if (!autop}) 
xdoti4) = turning response gain 
* steer wheel angle: 


x 


work vector,3: 


else 


{ 


xdot.4| = cmd _psi dot: 


\ 
f 


\ * derivative ~ 
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D. Drisplay.c 


ie 
This module generates all the vehicle dashboard indicators. 


. Speedometer 
Odometer 

Compass 

Fuel Meter 

Help Panel 

Warning Panel 
Steering Whee} Display 


* 


dm C9 bo ee 


-~1 & or 


Some of the ideas here were adopted from fltsim.c. 


=include "road.h" 


extern Coord latri:3!\2'. ratri 3: 2°: 


extern lag transl, transi2. transis. transi4. trans22. fuell: 
extern Tag odotag!. odotag?. odotag’. odotag4. steerwheeltag: 
extern Tag dangertag. temoptay, belttag, sraketag, transil: 


extern Hoat heading xpos: 


[FR ERR RR ROK ROKR RR OR OR RRR OR OR KR OK ROK KR KK OK ROK KOR RK OR KOK KK KR KKK KK KKK HK K 


oPEEDOMETER 


KK KK KK KKK KKK KKK KK KOK KE KK KKK KK KEK EK KKK EK KKK KK KEK KKK KKK KKK KEK 


/ 


makethespeedometer(speedometer) 
Object *speedometer: 


{ 


Icoord charxpos, posl, pos2, tempx, tempy; 
Object meter,meternum: 


pos] = 467; pos2 = 150; 

tempx = posl + 90: 

tempy = pos2 + 80; 

charxpos = posl — 30; 

/* Generate outline for speedometer dial * 


meter=genobj(); 


makeobj(meter); 


color(BLACK); 
rectfi(posl, pos2, tempx. tempy); 


color( WHITE); 
rectfi(posl1+10, pos2+10, tempx-10, tempy-10): 
color( BLACh); 


cmov2i( pos1,pos2-15): 
emarstr(! km/hr "): 
latriiOl|0|/=post:; 
latrilO||1!'=190-9: 


latrii 1];0/=pos1—25: 
latriili 1i=190: 


fate. 0i=post: 

latrii2' i= L90—29: 
> 
ej 


Bol. |..latr:): 


ratriiO|iO|=rempx: 
ratril0}) 1!=i90-9: 


ratrii1|/O0j=tempx; 
ratri(1||1j)=190—9; 


ratri|2|/0|=tempx-25; 
ratri|2|{1}=190; 
polf2(3,ratri): 


closeobj(): 


/* Generate number in speedometer display * 


meternum=genobj(): 


makeobj(meternum): 
color(BLACKk); 


cmov2i(charxpos,000)}; 
charstr("000");: 
cmov2i(charxpos,030); 
charstr("010"); 
cmov2i(charxpos,060): 
charstr("020"); 
cmov 2i(charxpos,090); 
emarstr( 030"): 
cmov2i(charxpos, 100): 
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charstr('"040"); 
cmov2i(charxpos, 125); 
charstr("050"); 
cmov2i(charxpos, 150): 
charstr("060"): 
cmov2i(charxpos,175); 
charstr("070"); 
cmov2i{charxpos,200); 
charstr("080"); 
cmov2i{charxpos.225): 
charstri"990"}: 
emov2i{cnarxpos. 250}: 
enarstri 200"): 

COV ZilCnaLxpos. 213), 
charstc: 0"). 
cmov2i(charxpos.300); 
garstri. te 
cmov2itcnarxDos.o2 
enarsinn tou 
emovtilcnarxpos.v00}): 
earser: 140); 

Sm1Ov J16Maey OS, rai 
eiarstre: lou |: 
cemov2iicnarxpos, 400): 
CHiarstr: sL0U 4 
‘mov2i(cnarxpos.+25}: 
emarser 1.0) ): 
cmov2i(charxpos, 450); 
charstr("180"); 
cmov2i(charxpos,475); 
charstr('190"); 


closeob)(); 


[* * 


Put all pieces of speedometer together 


*speedometer=genobj(); 


makeob)j(*speedometer); 


/* Draw the boundary */ 

callobj(meter); 

/* Draw the display speedometer in the window */ 
scrmask(charxpos,tempx, pos2+10,tempy-10); 


pushmatrix(); 
transl4=gentag(); 
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maketag(transl4): 
translate(0.0,0.0.0.0); 
callobj(meternum); 
popmatrix(); 


/* Reset screenmask to full size screen */ 
scrmask(0,1023,0,767); 


view port(0,1023,0.767); 
closeob}j(); 


x 


} /* makethespeedometer 


ns ee REE SER EEE KR ELAR AKER ERASER SAE LR RK KEES 


rk eek ks oe Se oe Kk Ke Kcr Ree EKKO KCK eK KRM SKK ee Se eK Kee xe x 


makefuel{ fuel) 


Object “fuel: 


f 


Coord fuelx1. fuelx2, fuely1, fuely2; 
Object fuelbound.fuellevel: 


fuelxl 
fuelyl 


102.0: fuelx2 = fuelxl + 51.0; 
10.0; fuely2 = 340.0: 


/* Generate outline for fuel indicator * 


fuelbound=genobj{): 
makeobj(fuelbound); 


color(BLACK);: 

rectf(fuelx1, fuely1, fuelx2, fuely2); 
emov2(107.0,345.0): 

charstr("fuel"): 

/* Generate hash marks for fuel levels */ 
linewidth(3); 

move(fuelx2. fuely2-30.0, 0.0); 


rdr(5.0, 0.0, 0.0); 
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/* cmov2(fuelx2—6.0, fuely2-35.0); 
charstr{" Full"); */ 


move(fuelx2, fuely1+60.0, 0.0); 
Fano O00 10:0)): 


/* cmov2(fuelx2—6.0, fuely1+55.0); 
charstr(" Empty"); */ 


linewidth{1); 
closeob}j(}; 
-* Generate the fuel level bar that moves ~* 
fuellevel=genobj({): 
makeobj(fuellevel): 
color( WHITE); 
rectt(fuelxi—+.0. fueivi-4.0. fuelx2-4.0. ruetv2-4.0}: 
closeop}|{); 
* Put ail pieces of fuet sogether * 
“fuel=genob)(); 
makeobj(*fuel); 


callobj(fuelbound}; 


callobj(fuellevel); 
eolor| YELLOW |: 


fuell = gentag(); 

maketag(fuell): 

rectf(fuelx1+4.0, Fuelyl1—4.0, fuelx2-4.0. fuely2-4.0); 
color(BLACh); 

closeob)({); 


\ /* makefuel */ 


[RRR KKK KR KR RK KR EEK KK KK ERE RK KK RK KK RK KKK KK KR KK KEK KKK KKK KEE 


HELP PANEL 


FER ER KR OR ROKK KKK KK KR RK KKK KKK KKK / 
é 


makehelp(help) 
Object *help; 
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{ 


*help=genobj(): 
makeobj(*help); 


color(BLACK): 


rect fi(10,10,90.340); 
color(WHITE): 
meewny lo, 15.85.2235); 
color(BLACK): 

/* Generate info on display * 
linewidthi 2}: 


emov 21( 10.545): 
Siarstr(’ heip "}: 
Bmovcit.c.ol5): 
eaarser( &xit''}- 
eevor1 RED): 

circti{ 29.200.6}: 
circ fi(50.300,6); 
circ fi(71,300,6); 


color(BLACK); 
emov 2i(21,275); 
charstr(" Speed "); 
circi(29,260.6): 
circi(50.260,6): 
color(RED); 
circfi{71,260,6); 


color(BLACK); 
emov2i(21,235): 
charstr(" Brake"): 
color(BLACK): 
circi(29,220,6): 
color(RED); 

circ fi(50,220,6); 
color(BLACK); 
eimei( 7 1,220,6); 


cmov2i(21,195); 
Eharstr(’” Stop"); 
color(RED); 
circfi(29,180,6); 
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color(BLACK): 
circi(50,180.6}); 
circi(71,180,6); 


cmov 2i( 10,115); 
charstr('’ Press‘): 
cmov2i( 10,95), 
charstr(" h_ "); 
cmov2i(10,75); 
eharsir| stor) ’): 
color(RED): 
emov21( 10.38}: 


Nansen! “iit. 


3 


cmov21{ 21.135}; 
énarsir!’ Prake"): 
remo. bo 0LG): 
eolorim i.) ic 
eIrentoUn 204: 
SOlOrl ono 
SIECt ada UO: 


emowaal 32.951: 
Sansom cs bso 
‘orort BLACK}. 
eire1{ 29,380.95): 
color(RED); 
circfi(50.80,6); 
circfi(71,80,6); 


* 


color(BLACK); 
closeob}j(): 


} /* makehelp *) 


[EPTFE EE TERE CEE ELPA EERE ER OS AS Ee ee ee 
/ 


ODOMETER 


SERRE SERRE EERE SRE EES EES a ea 


maketheodometer(odometer) 

Object *odometer; 

{ 

Icoord posl, pos2, tempx. tempy; 

Coord temp. charx, chary; 

pos! = 467; pos2 = 50; 

tempx = pos! + 90; tempy = pos2 + 50; 
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*odometer = genobj(); 


makeob}j(*odometer); 

color(BLACK); 

rectfi(posl, pos2, tempx, tempy); 
color(WHITE); 

rectfi{pos1+5, pos2+5, tempx-5, tempy-5); 
color(BLACK); 


temp = (tempx - posi - 10)/4; 
move2(posit+5—+temp, pos2—5): 
draw2(posl—5—temp, tempy-d): 


move2(posi+5+temp*2, pos2—5); 
draw2{posl+5~temp*2, tempy-5); 


x 


move2(posl1+3+temp 


x 


Jepos2—o)* 
draw2{posl—5~+temp*%. tempy-5}; 
move2(posl—5—temp*4, pos2—5): 
draw2(posi-—5—temp 4. tempy-o};: 


charx = pos!—d5-—-temp: 2: chary = (tempy-pos2) '2—pos2-5.0: 


cmov 2(cnarx. charv); 
odotag!l = zentag(): 
maketag(odotag 1); 
charstr("0"); 


cmov2(charx + temp, chary): 
odotag2 = gentag(): 
maketag(odotag2):; 
charstr("0"); 


cmov2(charx + temp*2, chary): 
odotag3 = gentag(); 
maketag(odotag3); 
charstr("0"); 


cmov2(charx + temp*3, chary): 
odotag4 = gentag(): 
maketag(odotag4): 
emarstr("0"}; 


color(BLACK); 
cmov2i(posl,pos2-15); 
charstr(" meter"): 
closeob}(}; 

} /* maketheodometer */ 


a ge te tS ESL E SEA Re a Ree RE Kee et 
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WARNING PANEL 


kok ok a oR OK a ok ROR ORR oR KR oR OK OK OK ROK KKK OK OK kK KKK / 
i 


makewarning(warning} 

Object *warning: 

Coord tempx, tempy, posl. pos?2; 

Coord 1x, iy. tempyl, tempy2, tempy3, tempy4, hg: 


pos] = 840.0; pos2 = 10.0; 
tempx = posi ~ 140.0: tempy = 340.0: 
iy =x = 20.0. 


*warning = genobi(); 
makeob}{* warning): 


colori BLACh}: 
recti(posl., pos2. tempx. tempy}: 
Neel 1a ee 


dangertag = gentagi}: 

maketag!/dangertag!: 

color{RED}: 

rectf{pos{—ix. pos2—iv. tempx-ix. pos? -!v —1¢): 
color(BLACh): 

cmov2(posl + (tempx-pos1)/2 - 25.0, pos2+1y+hg/2-5.0); 
charstr("Danger"); 


temptag = gentag():; 

maketag(temptag); 

color(RED); 

rectf( pos1+1x,pos2—~—iy *2+hg,tempx-ix,pos2+iy*2+2*hg); 
color(BLACh); 

cmov2(posl + (tempx-posl)/2 - 12.0, pos2+i1y*2+hg+hg/2-5.0); 
charstr("Temp"); 


belttag = gentag(); 

maketag(belttag); 

color(RED); 
rectf(posl+ix,pos2~iy*3~—hg*2.tempx-ix,pos2+iy*3+3*hg); 
color(BLACK): 

cmov2(posl ~ (tempx-posl)/2 - 40.0, pos2+iy*3+hg*2~hg/2-5.0); 
charstr("Seat Belt"); 


braketag = gentag(): 

maketag(braketag); 

color(RED); 

rectf(posl+ix, pos2+iy *4+hg*3,tempx-ix,pos2+iy *4+4*hg); 
color(BLACK): 

cmov2(posl + (tempx-posl)/2 - 17.0, pos2+iy*4+hg*3+hg, 2-5.0): 
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charstr("Brake"); 


color(BLACK); 
cmov2(pos1+20.0, tempy~+5.0); 
charstr({" Warning"); 


closeobj(); 
} /* makewarning */ 


J RR Re KOK KK RO OE KE KOR OOK ROR ee OR OKO KO OOK OK OO OOK KK OK Oe 


Sl ebereNG WHEEL 


KK KKK KK KKK KR KEK ERK RE KK KKK KKK Kee Ke eK 


makesteerw neel{steerw nee! 
Object “steerwneet: 
{ 

, steerwnheei = genoo}|}: 
makeobd}{ *steerwneet); 
pushmactrix({}: 
color(BLACKA): 
mineiiol2. 290. 10): 
color( WHITE}: 
eireniol2, 290, 30); 
color(BLACK); 


translate(512.0, 290.0, 0.0}; 
steerwheeltag = gentag(); 
maketag(steerwheeltag}; 
rotate(0, ’Z’); 

rectfi(-32, -5, 33, 5); 


popmatrix(); 
closeob)(); 


} /* makesteerwheel * / 


Mg 8 ESTEE EERSTE SEER EE EE SES 


HEADING ME tr ik 


KKK KKK KKK KKK KKK KKK KKK KKK KKK KKK KKK KK KK KKK KKK KKK KKK KA K KKK KKK KKK / 
/ 


makeheading(heading meter) 
Object *heading meter; 


{ 
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Object meter, theading: 

Coord posl, pos2, tempx. tempy: 
pos! = heading xpos; pos2 = 350.0; 
tempx = pos] + 175.0; 

tempy = pos2 — 12.5; 


meter = genobj(); 

makeob}(meter); 

color(BLACK); 

rectf(posl-2.5, pos2-2.5. tempx+2.5. tempy—2.5}: 
color{ WHITE): 

rectf{posl. pos2. tempx. tempy}; 

closeob){); 


* x 


Generate the heading on top of the terrain map 
tneading=genop}t}: 


makeoodlitheading}: 
ecojior({ BLACK]: 


emov 2{000.0.po0s2-2.)): 
marstrt etU 


“mov 2{045.0. pos 2-2?.)}: 
Chlarsenl cou"); 


cmov 2(090.0, pos2-2.0): 
charstr("360"); 


cmov 2({135.0,pos2-2.0}): 
charstr("010"); 


cmov2(180.0,pos2-2.0}); 
charstr({"020"); 


cmov2(225.0,pos2-2.0); 
eharsur( "O30" ) 


cmov2{ 270.0, pos2-2.0): 
charstr("040"); 


cmov2(315.0, pos2-2.0}; 
charstr({"050"); 


cmov2(360.0,pos2-2.0); 
charstr("060"); 


cmov2(405.0,pos2-2.0); 
charstr("070"); 
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cmov2{450.0,pos2-2.0); 
charstr("080")}; 


cmov2{495.0,pos2-2.0); 
charstr("090"): 


cmov2(540.0,pos2-2.0); 
enarstr( 100"): 


cmov2({585.0,pos2-2.0); 
enarser( 110"): 


emov2(630.0.pos2-2.0}: 
enarstr(''120"): 


cmov2(675.0.pos2-2.0): 
emarsir| 120"); 


emov2( 120.0. pos2-2.0}: 
charstr("140"): 


cmov 2{765.0.pos2-2.0): 
emarsor( 150"): 


cmov2{8&10.0.pos2-2.0}: 
emarsirt !60''). 


cmov2(855.0,pos2-2.0); 


charstr{"170"); 


cmov2(900.0,pos2-2.0); 
charstr{"180"): 


cmov2(945.0,pos2-2.0); 
charstr{"190"); 


cmov2(990.0,pos2-2.0); 
@iarstr{"200"}- 


cmov2({1035.0,pos2-2.0}; 


emarstr("210"'): 


cmov2({1080.0,pos2-2.0): 


emarser(''220"}- 


cmov2(1125.0,pos2-2.0); 


emareir( 230"): 


cmov2({1170.0,pos2-2.0); 


charstr{"240"); 


cmov2({1215.0,pos2-2.0); 
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Chagstr( co}: 


cmov2(1260.0,pos2-2.0); 
charstr(''260"): 


cmov 2(1305.0,pos2-2.0); 
charstr("270"): 


cmov2(1350.0,pos2-2.0}); 
charstr("280"): 


cmov2(1395.0.pos2-2.0), 
charstr{'"290"): 


cmov 2(1440.0,pos2-2.0): 
Charstm sue"): 


emov2l1435.0.00s2-2:0)). 
enarsun! se 10} )}: 


cmov2(1500.0, pos2-2.0}: 
enarstri o20'): 


emov 2\1o10.0.00S2- 2.0): 
efharstrl aod" |: 


cmov2({ 1620.0, pos2-2.0}: 
charstr("340"): 


cmov2(1665.0,pos2-2.0); 
charstr("350"); 


cmov2{1710.0,pos2-2.0); 
charstr("360"): 


cmov2(1755.0,pos2-2.0); 
charstr("010"); 


cmov2{1800.0,pos2-2.0); 
charstr('"020"); 


color(BLACh); 
closeob}j(); 
z j 


/* Put all the pieces together 


“heading meter=genob)(); 
makeobj(*heading meter); 


/* Draw the boundary */ 
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callobj(meter); 

/* Draw the heading */ 
scrmask((int) posl,(int) tempx,(int) pos2,(int) tempy):; 
pushmatrix(); 


transli=gentag(): 
maketag(trans]1): 


transiate{0.0.0.0.0.0}: 


callobj(theading}; 
scrmask(0,1022,0.767); 
popmatrix(}; 


color( RED}: 

linewiath(4}: 
move2(posi—175.0/2.pos2}-: 
draw 2(posi—175.0/2.tempy}: 


imewiathi 1): 


» oe ee x 
t f 


Seemask(Q.1023.0. 
closeod){ }; 


} /* makeheading *, 
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E. © Other:¢ 


jie 


This module contain the supporting routines for building the 
scenery objects like the clouds and mountains. 


zinclude ‘road.h" 


extern Dimension Roadlen. Roadwiath, Bendraaius1: 
extern Lag skylooktag, terrainiiooktag; 

extern Tag houselooktag. housetranstag; 

extern Tag housescaletag; 

extern Tag house!llooktag. nouseltranstag: 

2xtern lag nouseiscaletag: 

extern Angie Fov: 


Ce Kee eK KEK KK KEK EEK KK KKK Ce KO KKK KEK KKK 


So lik 


Ke KKK KKK KEK Ee KKK EK KOK Kee KKK KK 


MaKelNesKVISKY } 
Object *sky: 

{ 

*sky= genob)(); 
makeobj(*sky); 


pushmatrix(}; 

pushviewport(}: 

viewport(0, 1028, 385, 767): 
setdepth(0,1023): 

perspective(Fov. 1023.0/385.0, 0.0, 1023.0}; 


skylooktag = gentag(}: 
maketag(skylooktag); 
lock at((0'0.0:0. 0 0,-0.0; 0:0)0.0.20)). 


pushmatrix(); 

translate(0.0. 100.0, 50000.0): 

surf(0.0, 0.0, 0.0, 100000.0, 100000.0, SKY}; 
popmatrix(); 


popviewport(}; 
popmatrix(); 
closeob)j(); 

} /* makethesky */ 
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[RRR RK KKK KKK KK KK KKK EK KKK KK KK KK KK KKK KKK KKK KKK KKK KKK KK KK KEK KK EK 
i 


Sroubls AND MOUNTAINS 


MMR nN Ree ESE SESS AER E EN / 


maketerrainl(terrain1) 

Object *terrain1; 

{ 

Dimension temp = -(Roadlen+500.0): 
Dimension templ = -{(Roadlen—500.0}; 
Dimension tempy = 0.0; 

Dimension tempyl = 100.0: 
Dimension tempy2 = 350.0: 


*terrainl= genobj(): 
makeobj(*terrain1): 


Generate some ciouds 


pushmatrix(}; 

pusnviewport(}: 

viewportiO. 1023. 385. 767). 
setdepth(0.1023); 

perspective{Fov. 1023.0/385.0. 0.0. 1023.0): 
terrain llooktag= gentag(); 
maketag(terrainllooktag}: 
isemav0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0); 


pushmatrix(); 

color( WHITE): 

translate(-1000.0, tempyl, temp); 
scale({1.0, 1.0. 1.0); 

rotate(-900, ’Y’); 

einen 0.0, 0.0, 40.0); 

eimer(b0.0, 0.0, 30.0); 

circf(40.0, 50.0, 40.0); 
popmatrix(); 


pushmatrix(); 

color(WHITE): 

translate(-1000.0, tempy1, temp); 
scale(1.0, 0.8, 1.0); 

ciref(0.0, 0.0, 40.0): 

circf(50.0, 0.0, 30.0); 

circf(40.0, 50.0, 40.0); 
popmatrix(): 


pushmatrix(); 

color( WHITE); 

translate(-2000.0, tempy1l, temp); 
Seale(2.0, 2.0, 1.0); 
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rotate(-900, ’Y’); 
circf(0.0, 0.0, 40.0); 
circf(50.0, 0.0, 30.0); 
ciref(40.0, 50.0, 40.0): 
popmatrix(); 


pushmatrix(); 

color( WHITE); 
translate(-2000.0, tempyl, temp); 
scale(2.0, 0.8, 1.0): 

circf(0.0. 0.0, 40.0): 
cirel(50.070-0), 20:0}: 

circf{40.0. 50.0. 40.0}; 
popmatrix(); 


pushmatrix(): 

color( WHITE): 

translate({ 2000.0. tempvl. temp): 
scale(s.0. 2.0. 1.0): 

rotate/-900. ‘Y"): 

elrch( 0:0, 0:0. 20.0): 

circti 50.0. 0:0). 30:0). 

circi{40.0. 50.0. 40.0): 
popmatrix(}: 


pusnmatrix{ }: 

color( WHITE): 

translate(2000.0. tempyl, temp); 
scale(2.0, 0.8, 1.0); 

circk(@:050:0) 40.0): 
eirei(50;0,.0.0,, 30,0): 

circf(40.0, 50.0. 40.0); 
popmatrix(): 


/* Generate some mountains * 


pushmatrix(): 

translate(-2000.0. tempy, temp); 
scale (1.0. 0.1. 0.0); 
color(MOUNTAIN1): 

arcf(0.0. 0.0, 400.0, 0, 1800); 
popmatrix(}; 


pushmatrix(); 

translate(-1500.0, tempy, temp); 
scale (1.0, 0.2, 0.0); 
color(MOUNTAIN); 

arcf(0.0, 0.0, 250.0, 0, 1800): 
popmatrix(); 


pushmatrix(); 
translate(-1000.0, tempy, temp); 
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scare | 1-0, 0.1; 0.0): 
color(MOUNTAIN1); 
arcf(0.0, 0.0, 300.0, 0, 1800): 
popmartrix(); 


pushmatrix(); 

translate(1000.0, tempy, temp): 
peale (1.0, 0.2, 0.0); 
color(MOUNTAIN); 

arcf(0.0, 0.0. 250.0, 0, 1800): 
popmatrix(}; 


pushmatrix();: 

translate{ 1500.0. tempy. temp}: 
scale (1.0, 0.1, 0.0): 
color{MOUNTAIN1): 

peer0.0. 0.0. 500.0. 0. 1800): 
poomatrix(): 


ousnmatrix( }; 

transiate| 2000.0. cempy. temp}: 
poate i.1.0. 0.1. 0.0}: 

coiort MOUNTAIN 1): 

mremr0.0. ).0. 200.0. 0. 1800): 


popmatrix(}: 


popviewport( }: 
popmatrix(); 
closeobj{); 

\ /* maketerrain1*/ 


ies ot SEER REARS REA LAR RAR AR SEAS RHE & 


Pmuep SURFACES 


REE KRM KEK KKK KKK RK KKK KR KK KKK KR K RK KKK KK KEK KK KK KEK KKK KKEK KS i 


surf(x, y, z, width, length, roadcolor) 
[oond X, y, 2; 

Dimension width, length; 
Colorindex roadcolor; 


Coord vertice|5|[3); 
Dimension temp: 
temp = width/2; 


vertice|0|[0) = x; 
vertice(0|[1] = y; 
vertice(0|[2! = z; 


vertice{1]/0) = x - temp; 
vertice(1][1) = y; 
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vertice| 11/2 


ll 
N 


vertice|2|/0! = x - temp: 
vertice(2|/1) = y; 
vertice|2|/2° = -length:; 
vertice(3||(0' = x + temp; 
vertice[3|[1' = y; 
vertice|3|/2 = -length: 
vertice'4:.0' = x — temp: 
vertice|4uml — ¥- 
vertice:4,.2: = 2: 
color({roadcolor}; 


polf{5.vercice); 


\ * surf 


x 


ce Me eK SK KR KKK KC KC KE KK KK KT KE KKK eT EE EET KEK RK KEK Kee Eee 


oo) bee Oe) ee 


KKK RMR RE KK EKER RE K KK EK RK RSE KEE KK KEKE ERK EK TK KCK TTC CTT CK CEE KKK 


bend |} 


cotor; BLACK): 

archi(O, 0, (int) Bendradius1, 900, 1800}; 
color(FIELD); 

arcfi(0, 0, (int) (Bendradiusl - Roadwidth), 900, 1800); 


(RK KKK KKK KK KKK KKK KKK KK KKK KK KEKE KKK KKK KKK KKK KKK KKK KK KKK KEK 
‘ 


BUD si € Nes Oak 


KK KK KK KK KK KKK KOK KK KKK KKK KKK KK KK KKK KK KKK KR KKK KKK KKK KEK KKK KK KK ES 


/ 


signb(width, length, height, beolor) 
Dimension width, length. height: 
Colorindex bcolor: 

{ 

Coord vertice!5]'3 ; 

Coord verticel|5|| 3]; 

Dimension legwidth, templ, temp2, temp3; 
legwidth = 0.2; /* size of supporting leg */ 
templ = length/2; 

temp2 = length/4; 

temp3 = legwidth/2; 


vertice|0}/0 = 0.0; 
vertice|0|/1) = height; 
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vertice[0|/2; = 0.0; 


vertice|1||0) = -temp1; 
vertice|1|/1| = height; 
vertice[1]/2; = 0.0; 
vertice|2|/0) = -temp1; 
vertice(2||1| = width + height; 
vertice|[2]/2! = 0.0; 
vertice!3||0. = templ: 
vertice/3i/1, = width + height: 
vertice!3}/2. = 0.0; 


vertice|4||0: = temp!1: 
vertice/4|'1 = height: 
vertice/4||2' = 0.0; 


color( bcolor}: 
polf(5.vertice}: 


“ Generate the supporting leg 
verticel|O}/0! = 0.0: 


verticel|/Ol.1, = 0.0; 
Mepricel|U\:2! = 0.0: 
verticel|1/,0) = -tempé; 
verticel|1]{1] = 0.0: 


verticel{1|/2] = 0.0: 


verticel|2|/0| = -temp3; 
verticel|2||1| = height; 
verticel/2|/2| = 0.0; 


a 
verticel(3]/0| = temp3; 
verticel{3]/1| = height; 
verticel|3]/2} = 0.0; 


verticel/4|/0] = temp3:; 
vertice1|4]j 1] 210 (0k 
verticel(4]/2| = 030: 


color(BLACKk); 
polf(5,verticel); 
} /* signboard */ 


RM 0 FEE ENE EEE ES LESAN ER LRE REAR EE RE EK EH 


BUlLED ARROW 


KKK KKK KEK KK KKK KKK AK KK KK KKK KKK KKK KK KKK KKK KK KKKK KKK KKK KK KKKAKKK / 
; 
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polyarrow(bodywidth, headwidth. high, arrowcolor} 
Colorindex arrowcolor: 
Dimension bodywidth, headwidth, high: 


Coord vertice/5|/3,. vertice1/3}/3); 
Dimension bodyheight = 0.8: 
Dimension headheight = 1.5: 
Dimension temp1 = bodywidth/ 2; 
Dimension temp2 = headwidth/ 2; 


vertice|O!/0i = 0.0: 
vertice|0|,1; = 0.0 — high: 
vertice|0|/2' = 0.0: 


vertice|1//0! = -temp1: 
vertice(1)/1; = 0.0 — high: 
verticej1/'2' = 0.0; 

vertice!2'\0' = -iempl: 

verticei2) 1) = bodyheight — high: 
vertice(2|/2! = 0.0; 

vertice:y:'O) = tempL: 

vertice(o!' 1: = bodyheight — high: 
verticg@, =, — ().0: 

verticei4.;0! = templ. 


vertice/4; 1) = 0.0 + high: 
vertice| 4! Zi 0.0: 


color(arrowcolor); 
polf(5,vertice): 


verticel.0}/0 = -temp2; 4 
verticel:0|!1) = bodyheight + high: 
verticeliQ|/2! = 0.0; 


I! 


verticel 1|/0) = 0.0; 
verticel,1||1\ = headheight + high; 
verticel 1]{2, = 0.0; 


verticel 2|/0! = temp?; 
verticel 2}/1 = bodyheight + high; 
verticel'2|/2: = 0.0; 


color(arrowcolor); 
polf(3,verticel); 
\ /* polyarrow */ 


(JR RR OR ROK OR KOR KOK RK KKK KK RK KKK KK KKK KKK KR KKK KK KK KK KK KKK KKK KEE KK 
BUILD Heo Urs 
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ie Se SEE EERSTE RRR A EEE RAE AEE ERE 


makehouse({ house} 

Object *house: 

{ 

float sidewall|5]/2!, roof|4.'2). chmwall1i4'[2); 
float chmwall2/4][2], sideroofi4!(2': 


*house=genobj(); 
makeob}{*house): 


pushmatrixi ): 

pushviewport(): 

viewport(0. 1023, 285. 767); 
setdepth(0.1023); 

perspective(Fov. 1023.0/385.0. 0.0. 1023.0): 
houselooktag = gentag{); 
maketag{houselooktag!: 

feormani0.). 0.0. 0.0. ).0. 0.0. 0.0. 0): 


pusnmatrix{ j: 
1ousetranstag = gentayt): 
maketag(housetranstag}: 
translareiQ.0. 0.0. 0.0); 
housescaletag = zentag{): 
maketag| housescaietag!: 
scave( 1.0, 1.0, 1.0}: 


/* Draw front wall * / 


color(W ALL); 
rectf(-1.0,0.0,16.0,10.0): 


/* Draw side wall */ 


sidewall!0}/0|=(-4.0); 
sidewall Pte. OF 
sidewall! 1||0/=(0.0); 
sidewall|1]|1/=(0.0); 
sidewall /2|/0)=(0.0); 
sidewall|2]|1/=(10.0); 
sidewall /3]/0)/=(-3. i 
sidewall|3]{1)=(13.0 
sidewall!4}/0|=(-4.0 
sidewall/4]{1)=(11.5 
color(SIDEW ALL); 


polf2(5,sidewall); 
/* Draw roof and sideroof */ 
roof|0}/0|=(-1.0): 
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roof|0}{1]=(10.0); 
roof) 1]/0|=(17.0); 
roof}1}/1)}=(10.0); 
roof! 2]/0|/=(14.0); 
roo!) Ziit|/=113.5); 
roof 3|/0|=({-3.0): 
Foote 1 ==(1o201 6 
color{ROOF); 

polf2(4.roof}: 


sideroof|0!/0:={-4.3): 
sideroofi0|!1'={ 11.5): 
sideroof1|/0'=(-4.0): 
sideroofi 1]|1;=(11.5): 
sideroof!2/|0!=(-2.3}: 


sideroofi2?'' 1:=i 13.1}: 


sideroofi{onOl=i-3.0}: 
SideroOr nr 1 == eno: 
color(SIDEROOF): 


dolf2{4.siaeroot}: 
* Draw wincow * 


-olort WINDOW): 
Fectii2 01-00-0160): 
recti( 90.4.0 .12.0. 70). 


/* Draw window frames * / 


color(FRAME): 
linewidth(4); 
move{2.0,4.0,0.0): 
draw(5.0,4.0.0.0); 
draw{5.0,7.0,0.0); 
draw({2.0,7.0,0.0); 
draw(2.0,4.0,0.0); 
move({3.5,4.0,0.0): 
draw(3.5,7.0.0.0); 
move{2.0,5.5,0.0); 
draw(5.0,5.5,0.0); 


move(9.0,4.0,0.0}; 
draw(12.0,4.0.0.0}; 
draw({12.0,7.0.0.0): 
draw({9.0,7.0,0.0); 
draw(9.0,4.0,0.0); 
move(10.5,4.0,0.0); 
draw({10.5,7.0,0.0); 
move(9.0,5.5,0.0}; 
draw(12.0,5.5.0.0); 
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/* Draw chimney front wall */ 


color(SIDEW ALL); 
rectf(1.0,12.0,3.0,14.2); 
/* Draw the hole on the chimney */ 


color(BLACK); 
rectf(1.5,13.3,2.5,13.8); 


/* Draw top and side walls of the chimney * 


chmwall1/0//0!=0.3: 
chmwall1|0}|1:=12.5: 
chmwall1/1//0!=1.0; 
chmwall1:1!/1!=12.0; 
chmwalll:2)/0i=1.0: 
enmmawallil2"!)|=14.2: 
chmwailllis iO =0.35. 
emmiwailt)2,|v=i4.7: 


colori CHMW ALL1)}: 
polf2(4.chmwalll); 


chm wall2!01/01=2.3: 
chmwall2!0i/1:=14.7. 
chmwali2({1//0:=—3.0; 
chmwall2!1|1;=14.2; 
chmwall2 2)[0'=1.0; 
chmwall2/2/{1|=14.2; 
chmwall2,3'/0'=0.5; 
chmwall2/3'[1:=14.7; 


color(CHN@W ALL2): 
polf2(4.chmwall2}; 
popmatrix(}: 
popviewport(}; 
popmatrix(); 
closeob)(); 


} /* makehouse */ 


makehousel (housel) 
Object *housel; 


float sidewall/5]{2;}, roof|4//2|, chmwall1/4|/2]; 
float chmwall2/4]/2), sideroof|4]|2); 


*housel=genobj(); 
makeob}({*house1); 


pushmatrix(); 
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pushviewport(); 

viewport(0, 1023, 385, 767); 
setdepth(0,1023): 

perspective(Fov, 1023.0/385.0. 0.0, 1023.0); 
housellooktag = gentag(): 
maketag(housellooktag): 

lookat(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0); 


pushmatrix(): 
houseltranstag = gentag(): 
maketag(house ltranstag): 
translate{0.0. 0.0, 0.0); 
houselscaletag = gentag(}; 
maketag(houselscaletag}: 
scale(1.0, 1.0, 1.0); 


* Draw front wall * 


color(WALL1)}: 
recitl-).0,0,0:16-0. 10:0). 


* Draw side ‘vail * 


sidewail!0!/0'={-4.0): 
sidewalli0|: ti={2.0): 
sidewall 1:.0'=({0.0): 
sidewail! 1. 1,=(0.0): 
sidewall 2!|0|/=(0.0); 
sidewall 2)/1/=(10.0); 
sidewall! 3||/0|/=(-3.0): 
sidewall 3]/1)=(13.0); 
sidewall! 4|/0|=(-4.0): 
sidewall/4||/1]=(11.5); 


color(SIDEWALLI); 
polf2(5,sidewall); 


/* Draw roof and sideroof */ 


roof|0|/0|=(-1.0); 
roof|0]{1/=(10.0): 
roof] 1]/0|/=(17.0):; 
roof|1|{1]=(10.0); 


roof|2|/0/=(14. ms 
roof|2]|{1|= en 
roof/3]|0]=( 
roof|3]/1 a . 
color(ROOF 1); 
polf2(4,roof); 


sideroof|0|/0|=(-4.3); 


sideroof'0/!1 =(11.5); 
sideroof|1]'0 =(-4.0): 
sideroof!1|/1:=(11.5); 
sideroof|2]/0 =(-2.8): 
sideroof|2|!1 =(13.1): 
sideroof'3]/0'=(-3.0): 
sideroof(|3|/1!=(13.5); 


color(SIDEROOF)}: 
polf2(4.sideroof}; 


a 


‘* Draw window 


colori WINDOW}: 
Fecti| 2.0.4.0.5.0.7.0): 
rectf(9.0.4.0.12.0.7.0}: 


* Draw window frames ~ 


coior{ FRAME}: 
innewiathi 4}: 
movet 2.0.4.0.0.0): 
arawi5.0.4.0.0.0): 
gina w(5.0.,.0.0.0}: 
drawt2.0.7.0.0.0}: 
tfpawt2.().4.0.0.0): 
move{J.5.4.0.0.0}; 
einai o.d.7.0,0.0): 
move(2.0,5.5.0.0): 
draw (5.0.5.5,0.0}; 


move(9.0,4.0.0.0): 
draw(12.0,4.0,0.0}: 
draw (12.0,7.0.0.0); 
draw (9.0.7.0,0.0); 
draw(9.0.4.0,0.0); 
move(10.5.4.0,0.0}; 
draw (10.5,7.0,0.0); 
move(9.0,5.5,0.0); 
draw(12.0,5.5,0.0): 


/* Draw chimney front wall *, 


color(SIDEWALL}1): 
Beem 1,0,12.0,3.0,14.2); 


/* Draw the hole on the chimney */ 


color(BLACKk); 
rectf(1.5,13.3,2.5,13.8): 
/* Draw top and side walls of the chimney *, 


/ 
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chmwall1|0]/0/=0.5 
chmwall1/0]/1)=12 
chmwalll/1 io'= I o: 
Ree etn taro! 
chmwalll/2|/0,=1.0; 
chmwall1|2|[1'=14.2; 
chmwalll 3]/0'=0.5; 
eee \[1}=14.7; 


colon CHNIW ALLE): 
poif2(4.chmwalll): 


chmwall2'!0)'/0!:=2.5: 
chmwall2!0//1/=14.7: 
chmwall2' I os 


chmwall2'1/ 

chmwall2)2:i0i=1.0: 
chinwall2 £eii—14.° 
chm wall? 3200.3: 
chmwall2ny lW]=i4.7 


POIOTIA LLY) Ni 
poif2{4.cnmwall2 = 
HODMAcrix| }; 


Dopoviewport! }: 
popmatrix({}; 
closeobj({); 

} /* makehousel */ 
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F.  Help.c 


/* 
This module creates the welcome and help screen. 
oF 

#include "road.h" 


Static int parray/4}/2! = {{2 
{ 


: 75.600}, {250,625},{275.625},{300.600}}: 
Static int parrayl 4y/2) = mG 


Bday, 2oOa00ne 210,000).1 200,475} }- 


(2 


[56 OK KKK EK EK EO EE Ee EE EK KK OK OOK OR KE EK KOK OK OK OK 


Dye Cc OM E Dales PE Ae 


KKK RK KK KK KKK KK KK KK KKK KK KK KK KK EK KK KKK KKK KK KK KKK KK KK 


welcome } 


{ 


(x x 


Loop until we get a mouse button hit 


moior! 1 LOW): 


clear(); 
color{BLUE); 


rect fi(200,625,300,700): 
rect fi(200,600,225,625): 
polf2i(4,parray); 
rectfi(325,600,425,700): 
rectfi(450,600,550,700): 
rectfi(575,600,675,700); 
polf2i(4,parray 1); 


rect fi(200,475.225,500): 
rectfi(200,500,300,575); 
rectfi(325,475,425,575): 
rect fi(450,475,550,500); 
rect fi(450.500,475,575); 
rectfi(575,475,675,500); 
rect fi(575,500,600,575); 
rect fi(700,525,800,575); 
rect fi(737,475,762,525); 


color( YELLOW); 
Rect 220,650,275,675); 
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rectfi(350,625,400,67 
rectfi(475,600.525,62 
rectfi(475,650,525,67 
rectfi(575,625,600,67 
rectfi(625,625,650,67 
rectfi(225,525,275,550 
rectfi(350,525,400,550); 
rectfi(350,475.400,500); 
FeGul| i 20,050,000,000 |: 


5 
5 
5 
5 
5 


}; 
ys 
}; 
i 
); 
); 


color'BLACK); 


cmov2i(200.350);: 
charstr(" Welcome to the world of ROAD RALLY"); 


cmov2i{ 200,325): 

charstr(" You drive a car on a road controlling"): 
charstr{" its speed and direction with the"); 
cmov 21/ 200.300): 

charstr{"mouse. To exit the program"): 

charstr!" at any time press all chree mouse simultaneously."); 


emov?i( 200.275}: 
charstr{" After the bell ring. to continue with the"): 
charstri' program press tne jeft mouse button."}; 


cmov2i( 200,250); 
charstr("HELP is available by pressing the keyboard key h"); 
charstr(" while the car is moving."); 


linewidth(5); 

cmov2i( 200,175); 

charstr("Author : Tan Chiam Huat"): 

color(RED); 

cmov2i( 200,150); 

charstr("This image is contributed by: Mike Whiting"); 
color(BLACK); 

linewidth(1): 

swapbuffers(); 


\ /* welcome */ 


[RR AR RR KR KK RK KK KKK KK KOK OK KR kK OR KOR KOK OK OK KR OK KKK ROK OK OK KOK 


Fee? die sla 


Se ee EE EE RN 


help() 


lecord x = 100) 
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340; 
ee 


Icoord y 
Icoord iy 


/* Loop until we get a mouse button hit */ 


while (getbutton(MOUSE1) == 0 && getbutton(MOUSE2) == 0 && 
getbutton(MOUSE3) == 0) 
{ 


pushmatrix(}: 

pushviewport(}; 

viewport({0. 1023. 0, 380); 
ortho2(0.0. 1023.0. 0.0. 380.0); 
color(WHITE): 


clear(); 
color(BLACK); 
linewidth(5): 


cmov2ilx. v}; 
charstr("HELP INFORMATION: Press any mouse button to continue"): 


cmov2i(x, v - iy}; 


charstr("KEY REMARK"): 
eimov 2x, ¥-2">° 1}; 
charstr({"a or A or Lert button’ : Accelerate"); 


cmov2i(x, y - 3 * iy): 


charstr("b or B or Middle button : Brake"); 


cmov2i(x, y - 4 * iy}; 
charstr("c or C : Clock switch"); 


cmov2i(x, y - 5 * iy); 
charstr("e or E or Right button : Emergence Stop"); 


cmov2i(x, y - 6 * iy); 


charstr("h or H : Help"); 
cmov2i(x, y - 7 * iy); 
charstr("o or O : Odometer reset"); 


cmov2i(x, y - 8 * iy); 
charstr("q or Q : Autopilot"); 


cmov2i(x, y - 9 * iy); 
charstr("s or S : Sound danger"); 


cmov2i(x, y - 10 * iy); 
charstr("t or T : Timer (Integration)"): 
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cmov2i(x, y - 11 * iy); 
charstr("z or Z : Information"); 


cmov2i(x, y - 13 * iy); 


charstr("To TURN LEFT : Move mouse to the left"); 


cmov2i(x, y - 14 * iy); 
charstr ho PURN RIGH D : Move mouse to the right"); 


linewidth(1): 
popviewport!}: 
popmaztrix(); 
swapbuffers(): 


$ '* while *— 


\ s™ help * 
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G. Letter.c 


/* This routine is written for the IRIS-2400 
This is routine letter.c... 


This file supports routine title.c, which constructs the 


title page of the font building utility "BUILDFONT." 


This file contains routines to display block alphabetic characters 
suitable for inclusion into graphics objects. These letters are 
used instead of IRIS FONTS when one desires to treat them as 
graphics objects that can be rotated, scaled, etc. (font char- 
acters can’t) 


This file includes routines for 27 characters, "A" through "Z", 
and also re and it of (blank) (but not ee VOL) 


The routine draws the desired letter in absolute coordinates. 
in the center of the display. 


To use these routines, the coior desired for the letter must 
be specified when the object is created {in the user program), 
and the desired backgound color must be passed to the routine. 


Original version written bv J. Artero and R. Kirscn: current 
version written by L. Williamson 


oo) 


é 


#include "gl.h" 


zinclude "device.h" 


letter(asci, backcolor) 


int ascl; /* index of character we want to display */ 


/ 


Colorindex backcolor; /* specified background color */ 


Coord box [8]/[2); /* vector of coordinates forming the 
vertices of a letter object */ 


switch(asci) 


case ’A 
box/0]/0|=4.6875; 
box{0}[1]=3.25; 
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box|1][0]=4.9375. 
box|1][1}=4.235: 
box{2|[0]= 5.0625: 
box|2]{1)=4.25: 
box!3](0]=5.3125; 
box(3]{1]=3.25; 


color(backcolor); 
box[0][0]=4.8125:; 
box(0][1!=3.25: 
box) 1|(Oi=4.84375 
box|1}/1)=3.375; 
box[2]{0/=5.15625, 
box! Zi =3.3 ao: 
box|3 ![0' =o 1515 
box|o4l|—=3.20: 
polf2{4.box}: 


box!0:'0!=4.8 
box!Oi1/=2. 
box! 1. /Ol=5. 


boxib fii: 
poif? - box}: 


break; 
case ’B’: 


box[0][0]=4.6875; 
box(0][1]=3.25:; 
box|1|/0!=4.6875; 
box|1/1/=4.25; 
box[2]|0]=5.1875 
box|2][1]= 4.25; 
box[3]/0|=5.3125; 
box|3][1]=4.125; 
box{4](0)=5.3125; 
box|4|[1]/=3.375; 
box[5]/0|=5.1875, 
box[5][1]=3.25; 
polf2(6, box); 


color{backcolor); 
box[0|[0]=5.25; 
box|0]{1]/=3.8125; 
box|1][0]=5.3125; 
box[1][1]=3.875; 
box([2|/0|=5.3125; 
box2 ill —3.13, 
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polf2(3,box); 


box(0][0|=4.8125; 
box|0|[1]=3.375: 
box|1|[0|=4.8125; 
box[1|[1]=3. 1d: 
box(2][0]=5.125; 
box|2)[1)=3: 195 


box/3|[01=5.1875 
box/|3||[1) Ss 6875: 
boxi4!/0l=5.1875: 
boxi4|[1i=3. aD: 
Doxjo||Ol=—5. 125: 
box, o!|1i=3.275: 
polf2{6.box}: 
boxi0](0l=4.8125: 
bore) 1i=3.875- 
Pore i— 4.8125: 
Dox || ti=4.125; 
Boxe =5.125: 
Soma |) li=—4.125: 
Boxe Ol=5.1875- 
Boma) 1 (=4,0625: 
pox 4Olk—5.187a: 
noxl4|| LI =S.0575: 
DOX: 51/0, = OL 20: 
box! 5|[11=3.875; 
polf2(6,box): 
break; 

case ’C’: 


box!0|[0|=4.6875: 
box|0|[1]=3.375; 
box|1|[0|=4.6875: 
box{1][1]=4.125:; 
box(2][0]=4.8125; 
peice2 ||| 4.25. 
box|3][0|=5.1875; 
box|3|{1]=4.25; 
box|4][0|=5.3125; 
box|4|[1]=4.125; 
pox|5||/0|=5.3125; 
box|5|[1]=3.375: 
box(6]/0]=5.1875; 
box|6|[1|=3.25; 
box|7|[0]=4.8125; 
box|7|[1]= 
polf2(8, box); 
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color(backcolor); 
box|0]/0)=4.8125; 
box(0]/1]=3.4375; 
box{1]|0|=4.8125, 
box|1}[1)=4.0625; 
box|2|[0'=4.875; 
box|2/[1|=4.125; 
boxi3}Ol—57 825; 
Box|o)|1| 45125; 
box/4!/0}=5.1875: 
box4||1i=4.0625: 
box/51/0i=5.1875. 


2 


DOX oi —odoro 
boxt6||Ol=>. 125. 
box' 6/1 = 9.010: 
box 7. O\=4.875.- 
box:7 /1'=3.375: 


poif2(8.box}: 


—_ 


ACUI slat 0-00. eo 
DreBk. 
case. D” 


box; OliOi=+ 6870: 
pox; 0!|1:=3.25: 
box|1|/0'=4.6875: 
box/1|[1)=4.25; 
box! 2}/0|=5.1875: 
box! (2)[ 1, =4. 25, 


box!3}/0)=5.3125; 
box, = 125; 
boxi4||0'= S125: 
bowiallt'=8 io 
box[5|[0i=5.1875; 
boxe |i—3.25. 


polf2(6,box); 


color(backcolor); 
box|0] {0} =4.8125; 
box|O|ti=—2.376; 
box!1]|0,=4.8125, 
box|1|[1]=4.125; 
box|2|/0}=5.125; 
box(2][1|=4.125; 
box/3}[0]=5.1875; 
box|3}[1]=4.0625; 
box(4][0!=5.1875; 
box(4|[1}=3.4375; 
box[5]/0]/=5.125; 
box{5]|[1;=3.375; 


162 


polf2(6,box); 
break; 

case ’E”’: 
rectf(4.6875,4.125.5.25,4.25): 
rectf(4.6875,3.25.5.3125,3.375); 


rectf(4.6875,3.25.4.8125,4.25): 
ect!(4.8125.5.75)9.0625,3.875); 


break: 

case ’F’: 
rectf{(4.6875.3.25.4.8125.4.25}); 
feet 70815.4.125.9,.0125.4.25); 
Reece 125.0.10.0.125.2.875): 
break: 

case °H 
rectt(4 680.088 5.1.2125.4.25) 
SEGthEl oS 2 O8ot0e10.0.1875.0.8125) 
Peer oie io. 6.2 ).o.40 bed. 4.25) 


break; 
case ’]’: 


rectf(4.6875,4.125,5.3125,4.25); 
rectf(4.6875,3.25,5.3125.3.375); 
rectf(4.9375,.3.25,5.0625,4.25); 


break; 
case ’J’: 


box/0]/0/=4.6875, 
bex|0)|1/=3.375; 
box|1][0|=4.6875; 
box|1]/1]=3.625; 
box|2|/0)/=5.3125; 
box|2][1]=3.625; 
box/{3][0)=5.3125:; 
box{3]/1]=3.375; 
box|4]{0]=5.1875; 
box|4][1]=3.25; 
box(5)|0|=4.8125; 
box|5|/1|=3.25: 
polf2(6,box); 
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Rectilo.2,o/620,9.9120,4025); 


color(backcolor}: 
box|0][0/=4.8125:; 
box|0][1!=3.4375, 
box{1](0/=4.8125; 
box! 1|/1|=3.625; 

box|2](0]=5.1875; 
cone y = 3.629; 

box! 3 ols 1875; 
box!3}{1]= 
box )101— 
boxi4]/1/= 

box’ 5/0i= 
box st 
polf2(6, a 


Ce Q0 ts — ihn 
—~I =) to CO 
Orgei vi e#) 
Tec Cao Te ul 


=| 


break: 


case “K’: 


Pectil( 4.060950. 2900% dbo o4 2 oO) 


color! backcoiori: 
boxiOlfOi=4_SsT25: 
DOxION ti= 3.340. 
box! 1! O!l=4.3125: 
box(1]| j=4.25; 


box|2]/0|/=5.125:; 
box|2][1)=4.25; 
polf2(3.box); 


box{0][0|=5.02; 
box(0][1]=3.875; 
box|1]/0!=5.3125: 
box{1][1]=4.25; 
box/|2](0}=5.3125; 
box|2|{1]=3.25; 
polf2(3,box); 


box|0](0|=4.8125; 
box|0]{1]=3.25; 
box[1][0]=4.8125; 
box{1][1]=3.625; 
box{2]|0)/=4.9 
box([2]/1]=3.74; 
box(3]/0]=5.14; 
box[3]{1]=3.25; 
polf2(4,box); 


break; 
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case ’L’: 


rectf{(4.6875,3.25,4.8125,4.25); 
rect{(4.6875,3.25,5.3125 3.375); 


break; 
case ’M’: 
Pec GSeore. 25.09.01 25,4.25); 


coior{ backcoiori: 
box!0!/0i=4.6875: 
Bom(O| v4.25; 
box! 1|/0i=5.3125: 
Dox i==4.25: 
box!2!/0!=5.0: 
boxe i= 5.75: 


polf2(2.box}: 


pox'01(0i=4.8125: 
Dono |= 3.25: 
box! L//Ol=4.3125: 
box! 11|1i—Jetes.- 
box! 21!0i=5.123: 
pom ti=s.295; 
polf2(3. pox}; 


box/0][0|=4.875; 
box(0]/1]=3.25; 
box|1]{0|=5.1875; 
box([1][1]=2.81235; 
box/2][0|=5.1875; 
box|2][1]=3.25:; 
polf2(3, box); 


break; 
case ’N’: 
meeti(4.6875,9.25. .3125,4.25); 


color(backcolor)}; 
box[0]/0)=4.8125; 
Bex|0}|1)=3.25; 
box[1][0|=4.8125:; 
box(1][1]=3.9375; 
box(2][0]=5.1875; 
pexe|2|[1|=3.2a:; 
polf2(3,box): 


box[0][0]=4.8125: 
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box/(0][1]=4.25; 
box/1]/0|=5.1875; 
box) 1|(1]=4.25; 
boxi210|—olsio, 
box([2][1]=3.5625; 
polf2(3,box); 
break; 
case ’O’: 
boxi0|/0i=4.6875: 
box(Ollli=arune: 
box: 1]/0/=4.6875: 
box tl) —4125, 
box: 2|/Oi=4.8125: 
SOx 4525. 
FOX =—b 1 Cara 
DOM a. ==! 25: 
Dox i= suede S: 
DO =4- 125: 
boxe lOl=s/ 125. 
DOM OM, 6ane oe 
S70" 


boxid}iOl=5.1 
JORG ee | =a oe 
SOx = 4 Ones 
Doxa) Li=o.25: 


polf2(8, box); 


color(backcolor); 
box(0|/0|=4.8125; 
box|0|/1]=3.4375; 
box! 1|(0]=4.8125:; 
box/1]{1]=4.0625; 
box! 2|/0)=4.875; 
box[2][1|=4.125; 
box) s|O)—a:125; 
box([3](1]=4.125; 
box|4]{0]=5.1875: 
box/|4][1]=4.0625; 
box|5|{0)=5.1875; 
box!5][(1]=3.4375; 
box|6][0]=5.125; 
box|6|(t|=s. Lo: 
box|7|[0|=4.875; 
box |g) oon. 
polf2(8, box); 


break; 


case P’: 
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box!0][0)=4.6875: 
box|0]{1/=3.25; 
box|1]|0]=4.6875; 
box|1][1]=4.25; 
box(2][0]=5.1875; 
box|2]{1]=4.25; 
box|3|/0]=5.3125; 
box|3][1}=4.125; 
box|4|(0/=5.3125; 
boxl4i/11=3.25; 
polf2{5.box); 


color{backcolor); 
boxi0|/0!=4.8125; 
box(01[1;=3.25; 
box|1|/0|=35.3125; 
Box: 1} 1j—3.8125: 
box! 2/01=5.512 
porea til 3.20; 
polf2(%, box}: 


qye 


boxiOl/Ol=4.8125: 
boxiO// 1i=23.3123: 
box! 1//0i=4.8125, 
bot —1. 125: 
BomiOl=5.125; 
box! 2|/1)/=4.125: 
box|3|/0/=5.1875; 
box!3][1/=4.0625; 
box!4]/0)=5.1875; 
box!4|{1|=3.875; 
box/5]/0/=5.125; 
bex|5||1/=3.8125:- 
polf2(6, box}; 


rectf(4.8125,3.25,5.3125,3.6875): 
break; 
case ’R’: 


box|0|(0/=4.6875; 
box|0][1]=3.25; 
box! 1]|0/=4.6875; 
box|1][1]=4.25; 
box|2](0)=5.1875: 
box|2]/1]=4.25: 
box|3]/0/=5.3125; 
box|3]{1]=4.125; 
box|4][0]=5.3125; 
box/4][1]=3.25; 
polf2(5,box); 
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color{backcolor); 
box/0|[0}=5.1875 
box!0][1]=3.625; 
box|1]{0}=5.3125; 
box|1][1]=3.75; 

box|2]/0]=5.3125; 
box 2 Pliass 2a, 


polf2(3, box); 


box|0}/0) =4/oLo 
box Oj ali=3. ao. 

box, 1| Oe ace o: 
boxil! Al=4 ee 


Boe 3110 =5. 16:05. 
boxi3);1i=4.0625: 
box! 4! Ol=5.18735: 
box 448 n=3.8125: 
DOX ol g |=). 125: 
DOX Sip io. fo: 


poif2(6.box): 


boxi0!i0:i=4.8125: 
box/Olli=3.25: 
DOK end == A 25 
box 1)=3.625: 


box|2]/0|=5.05; 
box/2|[1}=3.625; 
box!3]/0}=5.175: 
box/3]|1 


case 7S’: 


bax|o}|ol=4. 6875 
box(0][1]=3.3 oF 
box[1]/0]=4. aN 
box|1}|1]=4.125; 
box|2|/0|/=4.8125; 


bexc|2 |i) 42s: 
box) a) |O)-=5- 18a 5; 
box(3][1]=4.25; 
box|4][0}=5.3125; 
box|4]/1]=4.125; 
box(5]/0]=5.3125; 
Bex oll = onono: 
box(6][0]=5.1875; 
box|6]|1)=3.25; 
box|7||0)=4.8125:; 
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box|7|[1]=3.25; 
polf2(8,box); 


color(backcolor); 
box|0]{0|=4.8125; 
box|0][1]=3.4375; 
box|1]|0]=4.8125; 
box|1|[1)=3.75; 
box|2]/0|=5.125; 
box|2)(1\=3.75; 


box/3i/Ol=5.1875: 
box(3|{1/=3.6875: 
boxi4|/0|=5.1875: 
box/4//1 1|=3.4375; 
box/5)/0\= oo. 
box!5|[1/= 3.3095 
box! ne Sao: 
Dexo | i=o.05 3: 


pei (7 oe: 


pox! 0! r= 41-342 
DoxiOWi=35.9375 
Oxi BOl=4t.5 LU 
pox; Lie li=4. 062: 
Ste eCi—=4.87 95: 


No ls 


boxl6l|11=3.875, 
polf2(7,box); 


box|0}/0/=4.6875; 
box|0]/1]=3.5625; 
box/1]/0]=4.6875. 
box{1]/1]=3.875; 
box/|2]/0}=4.8125; 
Bex) 2||1\=3.75; 
box/3 |[O]=4.8125; 
box, 2||1|=3.5625; 
polf2(4, box); 





box 0] 0 
box/0] 1 
box: 1]/0 


(O\=—oell87 5: 

| 

| 
box! 1]{1 

| 

| 


ae Si: 
9.1875; 
4.0; 
9.0129; 
4.0; 


box!2]/0 
box!2 1 


a 
le 
ee 
FE 
es 
= 
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box|3](0|/=5.3125; 
boxion asta: 
polf2(4,box); 
break; 

case IT’: 
recti(4.0810;4-125,0.012a.4920). 
rectii4.9375 4.20,0 O0O204-25)- 
break: 

case U': 
box!0 |Ol=4. 6875: 
box! oll ji= See. 
box! 1!/Oi=4.6875: 
Dox laste l So: 
boxi2!| Ol= 5315: 
boxe) tL =123- 
DON Ol=5.2 bro: 
DOMo mel =o. ay. 
boxe Ol=4 215: 
boxe ll =o. 
poif2{5.box): 
color, Dackcolor}: 


box|0|{0)=4.8125: 
box|0}[1|=3.4375; 
box|1](0)/=4.8125; 


bon =A 75) 
box(2}[0/=5.1875; 
box(2}{1] =A 5: 
box(3|[O]=5. ie 
box|3 aaa 5325 
box(4][0|/=5.01; 


box[4|[1]=3.375; 
box|5}(0|=4.875; 
box(5][1|=3.375; 
polf2(6,box); 


box{0|{0)=5. ag 
box|0]{1]=3 
box({1][0}= a 1875 
box|1][1}=3.375 
box|2][0)=5. 1875; 
box|2]{1]=3.25 


polf2(3,box); 
break; 


case ’Y’: 
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box|0|(0|=4.6875; 
box|0](1)=4.25; 
box|1|(0|=4.9375; 
box|1}(1]=3.75; 
box|2|[0|=5.0625; 
Box|2)|1|—3.15; 
box|3|(0|=4.8125; 
box(3][1}=4.25; 
polf2(4,box); 


boxi0||/0i=4.9375; 
pox|0)|t/—3. 195; 
box) 1]/0/=5.0625; 
box 11/=3.75: 
box|2|/0|=5.3125: 
box/21/1'=4.25: 
box/|3|/0i=5.1875: 
Dowio!| 1: —1.25: 
polf2{4. box}; 


BeGLi soo 1.070-20.0.0025.0.1 0)" 
break: 
case :: 


rect{(4.9375,3.35.5.0625,3.60); 
rectf(4.9375,3.90,5.0625,4.15); 


break; 


ease’ ’: 


break; 
/* end switch */ 


/* end routine "letter" */ 
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H. Find subgoal.c 


a 


Look for the next subgoal along the road 


#include "road.h" 
static Boolean start =} ALOL: 


find subgoal(roadmap, no coord, where, tolerance, pred distance, vx, vy. vz) 
float pred distance; 

float roadmap |\3': 

float tolerance; 

float vx. vv. vz: 


int no coord, where: 
§ 


4 
iloat dist, temp: 
loat x.y) 2: 
Int 1: 


for (1 = where: 1 < no coord: ——?) 


roadmap'1\/0 - vx: 


x 
= roadmapji| 1. - vy; 


<a 


z = roadmap|i|/2| - vz; 
dist = sqrt(x*x + y*y); 
temp = pred distance - dist; 
/* converts negative to positive */ 
if (temp < 0) 
temp = -(temp); 


if (!start) 


{ 


/* This works only when autopilot is turned 
on for the first time on the first stretch 
of the cicuit. Problem if otherwise. */ 


if (temp <= tolerance && roadmap|i][1) > vy) 


{ 
Start = ERUE- 


return(i); 


} 


else 
if (temp <= tolerance) 


{ 
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start = TRUE: 


return(i); 


} 


/* If no points found, return an error code */ 
return(-1); 


} /* find subgoal */ 


]. Map.c 


ie 
This module works independently from the rest of the system. 


This module generate the road map for autonomous navgiation. 


eos 
/ 


zinclude <stdio.h> 
+#include <math.h> 


main({) 

{ 
Pile “ty: 
int 1: 


x 


Road Specification * 
'* Note: Must match that used in the carsimu.c program * 
doat bendraaius = 30.U: 

float roaawidth = 16.0: 

float len) = 400.0: 

foat ien2 = 100.0: 

float lens = +00.0: 

float lena = 400.0: 

Hoat newx, newv. miss: 

float caix. caly. start raa: 

float perstep rad; 

float step = 1.0; /* road map increment step * 
float radl = bendradius - roadwidth/2: 

float rad2 = bendradius - roadwidth/?2:; 

float rad3 = bendradius - roadwidth/2:; 

float lastxvalue: 

float lastyvalue; 

float xX), yi, al 

Hoat x2,-y 2,22: 

float xa, ¥o, zo: 

float x4, y4, 24; 

float x5, y5, z5; 

float x6, y6, z6; 

NOat x7..y 0. 20. 

float x8, v8. 28: 


/* Road Segment Specifications * / 

x) = 0.075 = 0-0-2 1, = O10: 

x2 = OMe y 2° — fen? — 0,0; 

Xo = Tad vo — ye rad tz. — 0.0. 

M4 = Xo pelens V4 — 5.74 — U0 

x5 = x4 + rad2; yd = y4 - rad2; 25 = 0.0; 
x6°= X55 5701 5y 5 = lela az 6>— 10.0: 

Xi = XS -hadeay — VO-mads. 77, — 0.0. 
XO =X =lenae Ve = V1 
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tt on aa 


fp = fopen("roadmap", 


newy = yl; 
for (i = 0; newy <= y2; ++i) 
{ 
#ifdef DEBUG 
printf("%.2f %.2f %.2f\n""»,x1,newy,z1); 
#endif 
fprintf(fp,"%.2f %.2f %.2f\n",x1,newy,z1); 
lastvvalue = newy; 
newy += step; 
} 
newy = lastyvalue: 
miss = y2 - newy; 


#ifdef DEBUG 
printf("miss1 %.2f\n",miss); 
sendif 


start rad = 0: 
ieimiss > 0} 
{ 
eeahi rad — imiss‘rad!: 
calx = cos(start _tad); 
e€aly = sin(Start rad); 
newyv —= calyv: 7 
newx += caix: 
tifdef DEBUG 
printf("%.2f %.2f %.2f\n",x2+newx,y2+newy 22); 
#endif 
fprintf(fp."%.2f %.2f %.2f\n",x2+newx,y2+newy,z2); 


perstep rad = step/rad]; 
for (i = 0: newx <= x3; —+i) 
{ 
start rad += perstep rad; 
calx = radl * cos(start _rad); 
caly = rad] * sin(start_rad); 
lastxvalue = newx; 
lastyvalue = newy; 
newy = y2 + caly; 
newx = x2 — (radl - calx); 
if (newx < x3) 
{ 
#ifdef DEBUG 
printf("%.2f %.2f %.2f\n" newx,newy,22); 
#endif 
fprintf(fp,"%.2f %.2f %.2f\n" ,newx,newy,z2); 
} 
} 


newx = lastxvalue; 
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newy = lastyvalue: 
miss = x3 - newx; 


#ifdef DEBUG 
printf("miss2 %.2f\n" miss); 
+#endif 


if (miss > 0) 


newx = x3 — miss; 
+ifdef DEBUG 

printf("%.2f %.2f %.2f\n" newx.y4.z3); 
#endif 

fprintf(fp,"%.2f %.2f %.2f\n" newx,y4,z3); 


} 


for (1 = 0; newx <= x4; ——1) 
lastxvalue = newx: 
newx —= step: 
i i newN eo =. <4) 
zifdef DEBUG 


printt('¥o.2f 9.2) & 


mayan" newx,y4.z3): 
=endif 


forintlifpe sca! “osehe on” news. 4-70): 


newx = lastxvalue: 
Miss — <4 = new. 


#ifdef DEBUG 
printf("miss3 %.2f\n",miss): 
¢endif 


start rad = 0; 
if (miss > 0) 
{ 
start rad = miss/rad2; 
caly = rad2 * cos(start rad); 
calx = rad2 * sin(start rad); 
newy = y4 - (rad2 - caly); 
newx = x4 — calx; 
#ifdef DEBUG 
printf{("%.2f %.2f %.2f\n" newx.newy ,z4); 
#endif 
fprintf(fp,"%.2f %.2f %.2f\n" newx,newy,z4); 


} 


perstep rad = step/rad1; 

for (i = 0; newy >= yd; ++i) 
{ 
start rad += perstep rad; 
caly = rad2 * cos(start_ rad); 
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calx = rad2 * sin(start rad); 
lastxvalue = newx; 
lastyvalue = newy; 

newx = x4 + calx; 

newy = y4 - (rad2 - caly); 

if (newy >= y5) 


#ifdef DEBUG 
printf("%.2f %.2f %.2f\n" ,newx.newy,24); 
#endif 
fprintf(fp,"%.2f %.2f %.2f\n" newx.newy.z4): 
j 
} 


newx = lastxvalue; 

newy = lastyvalue; 

miss = newy - Vo: 
+ifdef DEBUG 

printf("miss4 %.2f\ n". miss): 
=endif 


aeariss > 0) 
J 


newv = vd — muss: 
zifdef DEBUG 


Demut( oo cf %.2f %o.2 


(eet Olin” Newx new. 25). 
zendil 
fprintf(fp,"%.2f %.2f %.2f\n",newx,newy,z5); 


for (i = 0; newy >= y6; ++i) 


lastyvalue = newy; 
newy -= step: 4 
if (newy >= y6) 


#ifdef DEBUG 

printf("%.2f %.2f %.2f\n",newx,newy,z5); 
#endif 

fprintf(fp,"%.2f %.2f %.2f\n",newx,newy.z5); 


} 


newy = lastyvalue; 

miss = newy - y6; 
#ifdef DEBUG 

printf("miss5 %.2f\n", miss); 
#endif 


start rad = 0; 
if (miss > 0) 


start rad = miss/rad3; 
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calx = rad3 * cos(start_ rad); 

caly = rad3 * sin(start_rad); 

newx = x6 - (rad3 -, calx); 

newy = V6 - caly; 
#ifdef DEBUG 

printf("%.2f %.2f %.2f\n" newx,newy,z5); 
#endif 


fprintf(fp,"%.2f %.2f %.2f\n" newx,newy,z5); 


perstep rad = step/rado. 

for (i = 0; newx >= x7: -—1) 
{ 
start rad ~= perstep rad: 
calx = rad * cosistart_ rad): 
Calvi = Trade — sin(start rad); 
lastxvalue = newx; 
lastvvalue = newv: 


newv = v6 - caly: 
HEWN =" 30 = fag -acalx) 
if inewxe = —-< 7) 


=ifdef DEBUG 

printit gern o.2! “elk nu mewx. newv. gol: 
=endil 

Pprinttiip:, °“s.2) “ae. cl nn new xX mewv zo 


i 


newx = lastxvalue; 
newy = lastyvalue; 
miss = newx - x7; 


#ifdef DEBUG 
printf("miss6 %.2f\n".miss); * 
#endif 


if (miss > 0) 
{ 
newx = X7 - miss; 
#ifdef DEBUG 
printf("%.2f %.2f %.2f\n" newx,y8,z8); 
#endif 
fprintf(fp,"%.2f %.2f %.2f\n" newx,y8,z8); 


} 


for (i = 0; newx >= x8; ++i) 


{ 


lastxvalue = newx; 

newx -= step: 

if (newx >= x8) 
#ifdef DEBUG 
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printf("%.2f %.2f %.2f\n" newx,y8,28); 
#endif 
fprintf(fp,"%.2f %.2f %.2f\n" newx,y8.28): 


} 


hewx = lastxvalue; 
miss = newx - x8; 


#ifdef DEBUG 

printf("miss7 %.2f\n",miss): 
#endif 

felose(fp): 
fe emain ~/ 
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Jd. Roadie 


typedef float Dimension; 


#include '"'gl.h" 
#include '"device.h" 
#include "math.h" 
#include "time.h" 
#include "stdio.h" 


#define SYSTEM ORDER 4 
#define MOUNTAIN 8 
#define MOUNTAINI 9 


#define SKY 10 
define FIELD 11 
#define WARN 12 
=define WALL ey 
«define SIDEW ALL 14 
=detine ROOF 15 
=define WINDOW 16 


=detine CHMWALLI 5 
=define CHMWALL? 13 
=denne SIDEROOF 19 
zdefine FRAME 26 
+detine SIDEWALLI 21 
#define WALLI1 2 
#define ROOF 1 23 
#define FRAME] 24 
#define WINDOW 1 2 


qn 


#define MAXFUEL 3000.0 
+define PI me 
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K. Makefile 


CFLAGS = -Zf 

SivCo = other.c \ 
integrate.c \ 
display.c \ 
letter.c \ 
help.c \ 
find subgoal.c 
cIrcuit.c | 
carsimu.c 


BS = other.o 


integrate.o 


displav.o » 
help.o 
carsimu.o 


find subgoal.o 
CIFCUll.oO 
letter.o 


earsimu: S({OBJS) 


ego carsimu SiOBJS) -Zf-2e¢ -.m 


Sees): road.h 


» 
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